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Abstract 

The  performances  of  the  extended  Kalman  filter  implementations 
for  three  different  target  acceleration  models  that  estimate  target 
position,  velocity,  and  acceleration  states  for  air-to-air  gunnery  were 
compared .  The  models  included  1)  a  first  order  zero-mean  Gauss-Markov 
relative  target  acceleration  model,  2)  a  first  order  zero-mean  Gauss- 
Markov  total  target  acceleration  model,  and  3)  a  constant  turn  rate 
target  acceleration  model.  Measurements  available  to  the  extended 
Kalman  filter  at  update  were  the  range,  range  rate,  and  the  error 
angles  between  the  true  line  of  sight  and  the  estimated  line  of  sight. 
Additional  evaluations  of  the  effect  of  variations  in  the  length  of  the 
sanple  period  and  the  effect  of  variations  in  the  variances  of  the 
measurement  noises  were  conducted  for  the  extended  Kalman  filter  using 
the  constant  turn  rate  target  acceleration  model.  All  evaluations  were 
acoarrplished  using  Monte  Carlo  simulation  techniques.  - 


COMPARISON  OF  THREE  EXTENEED 
KALM?N  FILTERS  FOR 
AIR-TO-AIR  TRACKING 


I  Introduction 


Background 

The  accurate  estimation  of  target  position,  velocity,  and  accel¬ 
eration  for  use  in  a  gunsight  algorithm  has  been  a  major  concern  for 
engineers  working  on  fire  control  systems.  From  the  earliest  gunsights 
used  during  World  War  I  to  the  operational  gunsights  on  the  present 
fighter  aircraft,  future  target  position  has  been  estimated  by  the  pilot. 
He  has  used  his  personal  experience,  developed  through  years  of  training, 
along  with  his  observation  of  the  relative  target  position  and  velocity, 
to  determine  where  the  target  might  be  one  bullet  time  of  flight  in  the 
future.  Therefore,  performance  in  air-to-air  gunnery  has  depended  on 
hew  much  experience  and  skill  each  pilot  has  in  estimating  future  target 
position.  For  gunnery  attacks  where  the  acceleration  vector  of  both  the 
target  and  attacker  were  coplan ar  (i.e.  in-plane  tracking),  the  depen¬ 
dence  on  pilot  experience  and  skill  did  not  create  a  significant  problem 
since  the  attacking  pilot  could  "pull"  the  bullet  stream  through  the 
target  by  changing  only  his  pitch  attitude.  Howeve-.,  as  the  performance 
of  aircraft  increased,  pilots  wanted  to  have  a  gun  solution  available  for 
out-of -plane  tracking  (snapshots)  or  front  (nose-to-nose)  attacks  because 
the  opportunity  for  in-plane  tracking  decreased  with  a  resultant  degra¬ 
dation  of  probability  of  hits. 

In  1979  the  hardware  and  software  required  for.  a  constant  gain 
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extended  Kalman  filter  to  estimate  target  relative  position,  velocity, 
and  acceleration  were  installed  in  an  F-106  aircraft  for  testing.  The 
estimated  target  data  were  used  by  the  gunsight  algorithm  to  compute 
and  display  predicted  target  position  at  one  bullet  time  of  flight  into 
the  future.  A  second  display  representing  the  calculated  bullet  path 
at  the  estimated  range  of  the  target  was  provided.  The  attacking  pilot 
then  flew  his  aircraft  so  that  the  two  displays  were  properly  aligned 
to  obtain  a  "correct"  gunnery  solution  based  on  the  target  parameters 
estimated  by  the  filter. 

The  constant  gain  extended  Kalman  filter  used  in  the  test  was 

* 

developed  in  a  line  of  sight  (LOG)  coordinate  system  using  a  first  order 
Gauss-Markov  relative  acceleration  model  (Ref  1:30-59) .  However,  two 
additional  filters  have  been  proposed  to  estimate  the  target  parameters: 
a  first  order  Gauss-Markov  total  target  acceleration  model  inertial 
coordinate  (GMI)  filter  and  a  constant  inertial  target  turn  rate  constant 
speed  inertial  coordinate  (CTRI)  filter  (Ref  2) . 

Purpose  and  Objectives 

Hie  purpose  of  this  thesis  is  to  present  a  comparison  of  the  capa¬ 
bilities  of  a  first  order  Gauss-Markov  relative  target  acceleration  model 
estimated  LOS  coordinate  frame  (C3COG)  filter,  a  GMT  filter,  and  a  CTRI 
filter.  Also,  results  for  variations  in  update  rates  and  measurement 
noise  are  presented  for  the  CTRI  filter. 

Hie  objectives  of  the  research  performed  for  this  thesis  were: 

1.  To  compare  the  performance  of  the  three  extended  Kalman  filters 
based  upon  the  proposed  target  acceleration  models,  when  ficwn  against 
three  different  target  acceleration  profiles.  These  profiles  were  chosen 
to  represent  realistic  target  manuevers  in  an  air-to-air  engagement  and 
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to  insure  that  none  of  the  filters  had  an  advantage  due  to  profile 
selection . 

2.  To  investigate  the  sensitivity  of  the  CTPI  filter  to  differ¬ 
ent  update  rates.  This  filter  was  chosen  because  it  was  expected  to 
have  better  performance  than  either  of  the  other  two  filters;  the  accel¬ 
eration  model  used  for  the  CTPI  filter  more  closely  approximated  actual 
target  accelerations,  especially  accelerations  with  a  non- zero  mean 
character is  tic . 

3.  To  investigate  the  sensitivity  of  the  CTPI  filter  to  different 
values  of  the  measurement  noise  ('The  measurements  are  discussed  in 
Section  II) .  Again,  the  CTPI  filter  was  chosen  since  it  was  expected  to 
have  the  best  performance  of  the  three  filters  (as  discussed  above) . 

Assumptions  and  Limitations 

The  systems  evaluated  for  this  thesis  were  nonlinear  either  in 
measurements  or  dynamics  and  measurements,  and  strictly  linear  Kalman  fil¬ 
ter  propagation  and  update  relations  could  not  be  used.  Several  methods  for 
approximating  a  solution  for  filters  with  no.,  linear  dynamics  and/or  mea¬ 
surement  models  exist  including  the  truncated  second  order  filter,  the 
Gaussian  second  order  filter,  the  linearized  Kalman  filter,  and  the  ex¬ 
tended  Kalman  filter  (Ref  3) .  For  the  filters  evaluated  for  this  thesis, 
the  extended  Kalman  filter  was  chosen  for  propagation  and  update.  This 
approximation  was  selected  since  it  incorporated  a  new  reference  state 
trajectory  each  time  new  state  estimates  were  calculated,  was  relatively 
simple  when  compared  to  either  of  the  second  order  methods,  and  was  cam- 
pa  table  with  the  program  used  to  perform  the  simulation  (See  Section  V) . 

The  coordinate  frames  for  all  three  filters  were  assuned  to  be 
inertially  space-stabilized  except  possibly  during  an  instantaneous  realign- 
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ment.  For  the  GMLOS  filter,  the  coordinate  frame  was  assumed  to  be 
impulsively  aligned  just  before  the  update  to  the  estimated  LOS  calcu¬ 
lated  at  the  end  of  the  propagation.  The  GME  and  CTRI  filters'  coordinate 
frames  were  assumed  to  be  constantly  aligned  with  an  earth-fixed  (space- 
stabilized)  reference  frame. 

Tracker  dynamics  were  not  included  in  any  of  the  filter  evalua¬ 
tions.  It  was  assumed  that  a  closed  loop  control  system  used  estimated 
target  relative  position  data  from  the  filter  to  point  the  tracker  along 
the  estimated  LOS  without  error  before  the  measurements  were  made.  Also, 
the  control  system  was  assumed  to  provide  an  inertially  space-stabilized 
tracker  during  measurements. 

The  assumptions  of  a  space-stabilized  coordinate  system  between 
updates  and  a  space-stabilized  tracker  during  measurements  reduced  the 
complexity  of  the  propagation  equations.  The  angular  velocities  of  the 
filter's  coordinate  frame  and  tracker  coordinate  frame  did  not  have  to  be 
integrated  to  provide  the  transformations  required;  the  transformations 
were  calculated  from  the  estimated  position  states  of  the  filter.  (See 
Section  II  and  TV)  .  If  an  inertially  rotating  coordinate  frame ■ for  either 
the  filter  or  tracker  had  been  used,  the  propagation  equations  would  have 
included  the  equations  necessary  to  obtain  the  transformations.  (See  Ref  1 
for  detailed  development  of  GMLOS  filter  with  rotating  filter  and  tracker 
coordinate  frames.) 

The  attacker's  position,  inertial  velocity,  and  inertial  accelera¬ 
tion  relative  to  an  earth-fixed  reference  frame  and  the  transformation 
from  the  attacker  body  frame  to  the  same  earth-fixed  frame  were  assumed 
to  be  available  fran  an  inertial  Treasuring  unit  (IMU)  without  error.  This 
assumption  was  made  since  the  errors  in  current  I.'TJs  were  much  smaller  than 
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the  errors  expected  to  be  oormitted  by  the  filter.  Also,  using  these 
data  without  adding  measurement  noise  provided  the  best  possible  per¬ 
formance  for  the  filter  for  a  given  set  of  filter  parameters;  the  inclu¬ 
sion  of  errors  in  the  I MU  measurements  would  reduce  the  accuracy  of  the 
filter. 

The  earth-fixed  reference  frame  used  in  the  development  of  the 
models  for  this  thesis  was  assumed  to  have  its  positive  axes  oriented  in 
local  north,  east,  and  down  { toward  the  center  of  the  earth)  directions.  In 
this  thesis,  when  position  data  are  referenced  to  this  frame,  the  position 
of  the  origin  of  this  frame  relative  to  the  surface  of  the  earth  will  be 
stated. 


II  System  Dynamics  Models 


Gauss-Markov  Line  of  Sight  Dynamics  Model 

Ihe  dynamics  equations  for  the  GMLOS  filter  were  developed  based  on 
the  assumption  that  the  filter's  coordinate  system  was  aligned  with  its  1- 
axis  along  the  estimated  LOS  and  with  zero  roll  orientation  with  respect 
to  the  local  horizon  (Fig  II-l) .  Also,  the  filter's  coordinate  frame  was 
assumed  to  be  space-stabilized  from  tj_  (where  the  minus  sign  indicates 
time  just  before  a  measurement  update  and  the  r  denotes  time  after  a  co¬ 
ordinate  realignment)  until  just  before  the  next  measurement  update  time 
(where  the  c  denotes  time  before  a  coordinate  realignment) .  At  time 
t^+2_,  30  orthogonal  transformation  matrix  between  the  filter’s  current 
coordinate  system  and  the  desired  coordinate  system  with  its  1-axis  along 
the  estimated  LOS  (based  on  the  filter's  estimate  of  the  target's  position 
at  VJ)  was  calculated.  Then,  the  filter's  current  coordinate  frame  was 
assumed  to  be  instantaneously  realigned  along  the  desired  coordinate  frame 
at  (See  Section  IV  and  Fig  II-2) 

Hie  state  vector,  x  -  (t) ,  chosen  for  the  GMLOS  filter  was 

~  L  [[«>>], 

P«T<t)]2 

[Vf(t>]3 

*  £  (t)  -  [  4 

[*»*«»(«]  5 

[  **£»  («]  7 

[Vfio], 

6 


t 


gure  II-l.  Orientation  of  (24L0S  Filter  Coordinate 

Frame  with  Respect  to  an  Earth  Fixed  Reference  Frame 


where 


and 


and 


and 


and 


k 


[  x^(«]  lf 
[  *T£x<t>]4. 

[  xT£A(ti] ,  = 


relative  position  of  the  target  with 
respect  to  the  attacker  at  time  t  along 
the  1,  2,  and  3  axes,  respectively, 
of  the  filter's  coordinate  frame 


5, 


relative  inertial  velocity  of  the  target 
with  respect  to  the  attacker  at  time  t 
along  the  1,  2,  and  3  axes,  respectively, 
of  the  filter's  coordinate  systsn 


[V*»(t>] 

L  9 


relative  inertial  acceleration  of  the 
target  with  respect  to  the  attacker 
at  time  t  along  the  1,  2,  and  3  axes 
respectively,  of  the  filter's  coordinate 
system 
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The  superscripts  I  and  T/A  denote  that  the  state  represented  a  total 
(as  seen  from  the  inertial  reference  frame)  relative  (target  with  respect 
to  the  attacker)  quantity.  The  L  subscript  denotes  that  the  state  was 
coordinati zed  in  the  filter's  coordinate  frame  (estimated  LCS  frame) . 

Fran  dynamics,  for  an  inertially  space-stabilized  coordinate  system., 
the  position  states  satisfied  the  differential  equations 


[  ?£»<«],-  [Vfttijg 

The  velocity  state  differential  equations  were  written  as 


(II-2) 

(II-3) 

(II-4) 


L  2 

[Vf  («]  3 

(II-5) 

IiTp<t)]s  - 

[Wti] , 

L  L  6 

(II-6) 

(II- 7) 

Finally,  a  first  order  Gauss-Markov  relative  target  acceleration  model 

given  by 

[IiTf(t)I  3  =  '  3  /  T1  +  W1  (11-8) 

[1xT^A(t)]  .  - f1  xT<CA(t)]  /  T,  +  W  (II-9) 

-  -pxT£A(t)]9  /  T3  +  w3  dl-10) 
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where 


T1#  ^ t3  =  target  relative  acceleration 

correlation  time  constant 
alang  the  1,  2,  and  3  axes, 
respectively,  of  the  filter's 
coordinate  frame 

and 

wl'  w2>  w3  =  zero  mean  white  Gaussian  driv¬ 
ing  noise  along  the  1,  2,  and 
3  axes,  respectively,  of  the 
filter's  coordinate  frame  account¬ 
ing  for  errors  between  the  target 
relative  acceleration  model  and 
the  true  target  relative  inertial 
accelerations 

was  selected  (See  Section  IV  for  values  of  t]_,  t2,  and  T3  and  the  strengths 
of  **2,  and  w^) .  The  choice  of  a  relative  inertial  acceleration  model 
far  the  GMD06  filter  was  motivated  by  the  fact  that,  if  the  attacker  were 
performing  in-plane  tracking,  the  target's  inertial  acceleration  would  be 
nearly  equal  to  and  closely  correlated  with  the  attacker's  inertial  accel¬ 
eration  (Ref  1:15) .  Thus  the  choice  of  a  first  order  Gauss -Markov  relative 
target  acceleration  model  was  appropriate. 

Note  that  Bqs  II -2  to  11-10  were  not  valid  during  the  small  interval 
to  tTr  when  the  filter's  coordinate  frame  was  rotated  to  the  new  orien¬ 
tation  calculated  frcn  the  estimated  target  position  at  tiro  t“c. 


New,  Eqs  II-2  to  II-1C  in  state  vector  form  were  written  as 


[**Tf  <«]  2 

IVf<t>]2 

[IxT(t)]  3 

[^w]  3 

-[lXT/A,t!]  3  ,  Tl 

[  iTf  <t>]  4 

[Vf<t>]  5 

[kTfit)]5 

= 

[Vf(t)]6 

(iT£A<t>]7 

■  [W, «], 

kT£A<t>]8 

L 

7* 

•  X 

,  H  , 

_ l 

-[rxTf  (t)],  /  33 

Note  that  Eq  11-11  is  in  the  form 


x  =  F  x  +  w 

which  is  a  linear  stochastic  differential  equation. 


(11-11) 


(11-12) 


Gauss-Markov  Inertial  Coordinate  Dynamics  Model 

The  dynamics  model  for  the  GMI  filter  expressed  the  relationship 
between  the  relative  position  of  the  target  with  respect  to  the  attacker, 
the  inertial  target  velocity,  and  the  inertial  target  acceleration  in 
an  earth-fixed  coordinate  frame.  Relative  position  states  were  chosen 
to  keep  the  magnitudes  of  the  position  state  estimates  as  small  as 
possible.  The  choices  of  inertial  target  velocity  and  acceleration  states 
were  made  to  facilitate  the  comparison  with  the  CTRI  filter  (to  be  dis¬ 
cussed  later)  and  to  allow  the  use  of  a  first  order  Gauss -Markov  inertial 
acceleration  model.  The  earth-fixed  coordinate  frame  origin  was  located 
on  the  surface  of  the  earth  with  the  axes  aligned  in  the  north,  east. 
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and  down  (toward  the  center  of  the  earth)  directions.  At  the  start  of 


the  simulation,  the  center  of  mass  of  the  attacker  was  located  at  an 
altitude  h  on  the  minus  down  axis  (See  Fig  II-3) .  For  the  short  time 
of  each  engagement  (12  seconds),  the  earth-fixed  coordinate  system  was 
assumed  to  be  an  inertial  reference  frame. 

The  state  vector,  x_-£,  for  the  GMI  filter  was 

[  xY'it)]  i 

[**  I  <«]  2 

[*x  i  -(t)}  3 

[  *T<t>]  4 


hi  <«]. 

hi  <«]9 


where 


and 


[xT(A<«]  4, 


[xT^A(t)]  7  =  relative  position  of  the  target  with 

respect  to  the  attacker  at  time  t  along 
the  north,  east,  down  axes,  respectively, 
of  the  earth-fixed  coordinate  system 
13 


t1*  *(t>]2. 

[Jx  J(t)J 


LXx  J(t)j8  =  inertial  target  velocity  at  tine  t  along 
the  north,  east,  and  down  axes,  respec¬ 
tively,  of  the  earth-fixed  coordinate 


system 


[** 

Ox  *(t)]6. 


[Xx  j(t)]9  =  inertial  target  acceleration  at  time  t 
along  the  north,  east,  and  down  axes, 
respectively,  of  the  earth-fixed  co¬ 
ordinate  system 

The  superscripts  I  and  T/A  are  discussed  in  the  section  on  the  G-UXS 
filter  dynamics  model,  the  superscript  T  denotes  target  quantities,  and 
the  subscript  I  indicates  that  a  quantity  was  coordinatized  in  the  earth- 
fixed  (inertial)  reference  frame. 

The  differential  equations  for  the  position  states  were  written  as 


[xT{A(t)]j_  =  [1x  J(t)]  2  "  i-Iv 
[xT/Nt)]4  =  [rx  x  (t)]  s  -  [Xv  x<t)]  2 

[^A(t)]?»  [Xx  J(t)]8  "  Pv  J<t)]3 


(11-14) 

(II-15) 


(11-16) 
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where 


["v*(t)]  1# 
(t)]  2 1 


and 

fcvjtt)]  3  =  the  inertial  velocity  of  the  attacker  at 
time  t  along  the  north,  east,  down  axes, 
respectively,  of  the  earth-fixed  coordinate 
system 

Note  that  the  superscript  A  denotes  attacker  quantities  and  the  superscript 
I  and  subscript  I  are  defined  above. 

New,  the  velocity  states  satisfied  the  differential  equations 


[XxJ  (t)J  2  = 

[^(t)]  3 

(II-17) 

CXXj  (t)]  5  - 

H 

X 

ft 

a\ 

(11-18) 

!>*?<«] , 

(11-19) 

For  the  GME  filter,  the  acceleration  state  dynamics  were  described 

by: 


3 

—  Pxj(t)]  3 

/ 

T1  +  W1 

(11-20) 

—  PxiCt)]  6 

/ 

T2  +  w2 

(11-21) 

—  PxJttjjg 

/ 

t3  +  w3 

(11-22) 

where  \ 

t^,  x2,  and  t3  =  target  inertial  acceleration  correla¬ 
tion  time  constant  along  the  north, 
east,  down  axes,  respectively,  of  the 
earth-fixed  coordinate  frame. 


and 


W]_,  w2 ,  and  w3  =  zero  mean  white  Gaussian  driving 


noise  along  the  north,  east,  and 
dcwn  axes,  respectively,  of  the 
earth-fixed  coordinate  system 
accounting  for  errors  between  the 
target  inertial  acceleration  model 
and  true  target  inertial  accelerations 
(See  Section  IV  for  values  for  t^,  12 ,  and  T3  and  the  strengths  of  w1# 
w 2 1  and  v/3)  The  choice  of  the  inertial  target  first  order  Gauss -Markov 
acceleration  model  was  motivated  by  the  desire  to  increase  the  filter's 
performance  for  out-of-plane  tracking  (snapshot  or  front  attacks) .  For 
out-of -plane  tracking,  the  target  and  attacker  accelerations  are  only 
slightly  correlated.  This  Gauss-Markov  acceleration  model  which  provides 
no  correlation  between  the  target  and  attacker  accelerations  was  considered 
to  be  an  appropriate  model  to  use  in  the  filter  dynamics  when  out-of -plane 
tracking  was  anticipated. 

Equations  11-14  to  11-22  expressed  in  state  vector  form  were  written 


’[  ct>]  i 

'  E'xj.ti], 

0 

E1*  1  <«]  2 

EM^L 

0 

0 

E1*  1  <t>]  3 

-[Ufdl]  3  /  \ 

0 

W1 

a 

hh 

•  X 

t _ 1 

[M<«]  5 

-Pvjtt)]  2 

0 

[‘x  l  (t,J  5 

s 

+ 

0 

+ 

0 

EJ«  ?  !>=)]  6 

-  [TxJ(t)]  6  /  Tj 

0 

W2 

4J 

•  X 

Pxjft)]. 

0 

px  1  (t)]  8 

K<«], 

0 

0 

J1*  J  (»],_ 

-EMw],  /  »3 

0 

-  w3. 
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Note  that  Sq  11-23  is  in  the  form 

•  (11-24) 

x  =  Fx+u  +  w 

which  is  a  linear  stochastic  differential  equation. 

Constant  Turn  Pate  Inertial  Coordinate  Dynamics  Model 

The  CTRE  dynamics  model  was  developed  based  on  the  assumption 
that  the  target  performed  a  planar,  constant  turn  rate,  constant  speed 
maneuver  (Ref  2) .  This  model  more  nearly  represented  the  actual  maneu¬ 
vers  that  a  target  might  perform  during  an  aerial  gunnery  engagement 
than  either  the  Gauss -Markov  relative  target  acceleration  model  or  Gauss- 
M_arkov  total  target  acceleration  model.  As  the  target  and  attacker  accele¬ 
rations  became  more  non-planar,  the  correlation  between  these  accelerations 
was  reduced.  The  total  target  acceleration  modeled  as  a  Gauss-Markov  zero 
mean  process  did  not  represent  accelerations  that  a  target  would  use  dur¬ 
ing  an  aerial  engagement  since  this  model  did  not  account  for  persistent 
accelerations.  The  CTEI  model  used  an  acceleration  model  that  did  not 
correlate  the  target's  and  attacker's  accelerations  and  allowed  for  per¬ 
sistent  (nonzero  mean)  accelerations.  This  model  eliminated  the  problems 

associated  with  either  the  GMLOS  or  GMI  dynamic  models. 

% 

Like  the  GMI  model,  the  CTRI  modal  expressed  the  relative  posi¬ 
tions  of  the  target  with  respect  to  the  attacker  and  the  inertial  target 
velocity  and  acceleration  in  an  earth-fixed  coordinate  frame.  (This 
coordinate  frame  is  discussed  under  the  GMI  dynamics  model) .  The  choice 
of  relative  position  was  made  to  decrease  the  magnitudes  of  the  positions 
while  the  inertial  target  velocity  and  acceleration  were  required  to 
calculate  explicitly  the  constant  turn  rate  needed  for  the  acceleration 
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model.  The  states  used  for  the  CTRI  model  were  the  same  as  for  the 
GM  model. 

The  position  states  and  velocity  states  satisfied  the  differen¬ 
tial  equations  given  by  Eqs  11-14  to  11-19.  The  difference  between 
the  G-'Z  and  CTRI  dynamics  model  was  the  acceleration  model  used  to 
represent  target  maneuvers.  For  the  CTRL  model,  the  acceleration  model 
was  given  by: 


where 


and 


3  " 

-llVll2 

[M(«] 

2  +  W1 

(11-25) 

6  " 

-iiYii2 

[hM 

-i.  u 

5  w2 

(11-26) 

9  * 

-iivii2 

8  +  w3 

(11-27) 

wj,  w2#  and  w3  *»  driving  noise  on  target  accel¬ 
eration  along  the  north,  east,  and 
dcwn  axes,  respectively,  accounting 
for  errors  between  the  constant 
turn  rate  acceleration  model  and 
the  true  target  inertial  accelera¬ 
tions  (See  Section  IV  for  the 
strength  of  ,  w 2 ,  and  w3) 

I  l^a>T|  I  =  the  square  of  the  magnitude  of  the  target's 
inertial  turn  rate  (to  be  evaluated  sub¬ 
sequently) 
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Equations  11-25  to  11-27  were  developed  from  the  application  of  the 
Coriolis  theorem  written  as 


(  KT\ 

£  /  IT  \ 

,  /  I  T  I  T  1 

\  l  ) 

dt '  —  ' 

+  |  (U  X  v  J 

t  ^  j  =  at  1  V )  +  1  ]  (n-28) 

where  x  denotes  cross  product  and 

X  T 

v  =  inertial  target  velocity 

I  T 

M  =  inertial  target  angular  velocity 
and  the  superscripts  I  and  T  before  the  derivatives  indicate  that  the 
derivatives  are  taken  in  the  inertial  reference  frame  and  a  target  body 
frame,  respectively-  New,  the  first  term  of  the  right  hand  side  of  Eq  11-28 
was  zero  since  the  target  was  assumed  to  be  at  a  constant  speed.  Thus 
Eq  11-28  became 

*i  (V)  -(V»V)  (11-29) 

dt 

Now,  the  derivative  of  Eq  11-29  with  respect  to  time  gave 

V _  J- 


a  II  T\  a  / 1  T  I  T 

-\HLXZ 
dt2  dt 


(H-30) 


or,  expressed  in  the  target's  body  frame 

Id2  _ 

dt: 


£(Y)  -  1(Y*YHY*(Y*: Y))  tti-31) 


Now,  since  both  the  target  speed  and  angular  velocity  were  assumed  con¬ 
stant,  the  first  term  on  the  right  hand  side  was  zero  and  Eq  11-31  became 

Y  (Y)  -  (V*  (  VxV))  (11-32) 

at2 
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Using  the  relationship  for  a  triple  cross  product,  Eq  11-32  was  written 
as 


d~t2 


\  - 

/  I  T  IT  \  I  T 

/  I  T  I  T 

!  = 

(  lit  *  V  j  ut  ~ 

\  u.  *  to 

I  T 

V 


(11-33) 


The  first  term  of  Eq  11-33  was  zero  since,  for  a  planar,  constant  angu¬ 
lar  rate,  constant  velocity  turn,  the  target's  inertial  velocity  and 
angular  velocity  vectors  are  perpendicular.  Thus  Eq  11-33  became 

T-  I1!1)-  -  I  I VI  I2  V  {IX -34) 

dt2 


which  was  the  vector  equation  form  of  Eqs  11-25  to  11-27. 

To  compute  ]  |IuT|  |2,  the  target's  inertial  acceleration  vector, 
IaT,  was  written  as 


I  T 
a 


I  T  I  T 
to  x  v 


(U-35) 

for  a  target  flying  at  a  constant  speed.  If  the  target's  velocity  vector 
was  crossed  into  both  sides  of  Eq  11-35,  then 


I  T  I  T  IT  /IT  I  T  \ 
vxa-  vxjuxvj 


(11-36) 


or,  using  the  triple  cross  product  relation,  Eq  11-36  became 


ITIT./ITITiIT  /ITITIT 
vxa  \v-vJo)  (  v.  *  )  v 


(11-37) 


Again,  since  the  target's  inertial  velocity  and  angular  velocity  vectors 
are  perpendicular  for  a  planar  constant  angular  rate  constant  velocity 
turn,  the  last  term  on  the  right  hand  side  was  zero.  Rearranging  Eq  11-37 

gave 


I  T 
0) 


(V,V)/  nvir 


(11-36) 
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New 

nvii2-  V-y  (ii-39) 

substitution  of  Eq  11-38  into  Eq  11-39  gave 

1 1 VI  I2  -  (V*V)-(V*VI/  IIVU4  umm 

If  the  actual  target's  inertial  velocity  and  acceleration  had  been  known, 
then  Eq  11-40  could  have  been  evaluated  using  the  known  values;  however, 
only  estimates  of  the  target's  inertial  velocity  and  acceleration  were 
available  from  the  extended  Kalman  filter.  Using  the  states  defined 
for  the  CTRI  filter,  Eq  11-40  was  written  as 

IIVII2 -  J(fVw] 5  [*,»(«],  -  [*xJ(t)]8)J 

3  [1Xi(t)]8  -  [V<t,]2  [V<«]9)2 

4tv<t,i 2  ♦  [^<«]  \  ♦  [^(t>]2)2  «i-<« 

Now  Eqs  11-14  to  11-19  and  11-25  to  11-27  written  in  state  vector  form  were 
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Since  the  magnitude  of  the  target's  angular  velocity  was  a  function  of 
the  state  variables,  Eq  11-42  is  a  nonlinear  stochastic  differential 
equation  of  the  form 

• 

x  =  f(x)  +  a  +  w  (11-43) 

which  is  properly  written  as  an  I to  stochastic  differential  equation 

dx  =  f (x) dt  +  udt  +  dj3 

where  d  denotes  the  differential  and 

£  =  vector  Browning  motion  process  of 
diffusion  Q. 
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Ill  Tracker  Models  and  Measurements 

Tracker  Model  for  Line  of  Sight  Filter 

The  tracker  used  for  the  LOS  filter  was  assumed  to  be  inertiallv 
space-stabilized  at  the  time  of  measurement  tp,  with  the  tracker's  1-axis 
pointed  along  the  estimated  LOG  without  error.  The  choice  of  a  space- 
stabilized  tracker  reduced  the  complexity  of  the  dynamics  model  since 
the  angular  velocity  of  the  tracker  did  not  have  to  be  integrated  to 
obtain  the  angular  orientation  of  the  tracker.  Further,  the  assumption 
that  the  tracker  was  pointed  along  the  estimated  LOS  with  no  error  elim¬ 
inated  the  requirement  to  add  noise  to  the  transformation  from  the  old 
tracker  coordinate  frame  at  t^c  to  the  new  coordinate  frame  at  tjr.  The 
2  axis  of  the  tracker  was  assumed  to  be  parallel  to  the  local  horizon 
of  an  earth-fixed  reference  frame,  and  the  origin  was  assumed  to  be 
located  at  the  center  of  gravity  eg  of  the  attacker  (See  Fig  III-l)  . 

The  angles  n (tj0)  and  v(t^c)  were  the  Euler  rotation  angles,  in  that 
order,  for  the  transformation  from  the  earth-fixed  reference  frame  cen¬ 
tered  at  the  tracker  location  to  the  tracker  (estimated  LOS)  coordinate 
system.  Hie  angle  n(tiC)  was  the  angle  between  the  north  axis  of  the 
earth-fixed  reference  frame  and  the  projection  of  the  estimated  LOS  into 
the  north-east  plane  (local  horizon)  of  the  earth-fixed  reference  frame 
at  tame  t^  .  The  angle  v(t^)  was  the  angle  between  the  projection,  of 
the  estimated  LOS  into  the  local  horizon  and  the  estimated  LOS  vector 
at  time  tT0.  These  two  angles  were  not  assumed  to  be  small  angles. 

Tracker  dynamics  were  not  included  in  the  filter  model;  a  closed 
loop  control  system  was  assumed  to  move  the  tracker  to  the  new  position 
without  error  before  the  next  measurement  was  taken.  The  new  tracker 
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Orientation  of  Tracker's  Coordinate  System  With  Res] 
to  an  Earth  Fixed  Reference  Frame  For  the  G^tLOS  ^il 


position  at  time  t^  was  calculated  from  the  filter's  estimate  of  the 
relative  target  position  at  the  end  of  the  propagation  interval; 
[*T£A<tr>jlf  [xT£A(t£c)] 4,  and  [xTf(trC)]7.  In  actual  implementation , 
the  estimated  position  v.ould  be  calculated  before  tj[.  Then  the  tracker 
controller  v.ould  have  time  to  move  the  tracker  to  the  new  position  before 
the  measurement  time  tj_  since  the  change  in  position  for  the  tracker 
would  be  small  for  the  short  intervals  between  tracker  movements.  Fur¬ 
thermore,  the  actual  position  of  the  tracker  relative  to  the  filter's 
reference  frame  v.ould  be  of  little  significance  as  long  as  the  trans¬ 
formation  frcm  the  tracker  coordinate  frame  to  the  filter's  coordinate 
frame  is  known,  the  tracker  is  space-stabilized  during  the  measurement, 
and  the  target  is  within  the  field  of  view  of  the  tracker. 

Measurements  for  the  Line  of  Sight  Filter 

The  measurements  _z( tj_)  assumed  to  be  available  frcm  the  tracker, 
were  the  range  R  between  the  target  and  the  attacker,  the  tangents  of 
the  azimuth  and  elevation  error  angles  a  and  e,  respectively,  between 
the  estimated  LOS  and  the  true  LOS,  and  the  range  rate  R  between  the 
target  and  the  attacker  (See  Fig  III-2)  .  Each  measurement  was  assumed 
to  be  made  by  an  independent  device  (i.e.  a  pulse  radar  for  range  and 
the  tangents  of  the  azimuth  and  elevation  error  angles  and  a  pulse  dcppler 
radar  for  range  rate)  .  Note  that  if  only  a  pulse  radar  were  used,  the 
range  and  range  rate  measurements  would  be  corrupted  by  time  correlated 
noise. 

All  measurements  were  ooordinatized  in  the  tracker  coordinate 
frame;  however,  the  tracker  and  GMLCS  coordinate  frames  were  defined 
identically.  Therefore,  the  measurements  z_(tj_)  were  expressed  directly 
in  terms  of  the  states  defined  for  the  C?4L0S  filter  in  Section  II.  Ihe 


measurements  at  time  t,  were  defined  by 


61(t.)=R(t.)  *  Vitti)  =([xT£A(t.)]  I 


+  W 


(HI-1) 


it^tanefti)  -*•  V2(ti)  «  -  [xT£A(tA)]7  /  [xT{A(ti)  ]  x  +  v2  (tA) 


(III-2) 


,(ti)=tan  +  V3O-)  =  [x^t-j]  4  /  [x^t-J  1  +  v3(ti) 


(III-3) 


*4(ti)-R(ti)  +  V4(ti)  =  (jV£A(t.)]2  x+  fx^Ct.)]  5  tT'£A(t. 

+  [1xT{A(ti)l8  [xTf(t.)]7)/  ([x^J^t^vlj 
+  [xT£A  (t±)]  h  +  v4(ti)  (III-4) 


where 


(t^)  «=  measurement  noise  in  range  at  time  t^ 
v2  (t^)  -  measurement  noise  in  the  tangent  of 
e  at  time  t^ 

v3  (t^)  ”  measurement  noise  in  the  tangent  of 
a  at  time  t^ 

v4(ti>  ■  measurement  noise  in  range  rate  at 
time  t^ 

and  tj_  denotes  the  time  of  the  i^1  measurement.  The  measurements  can  be 


written  in  the  form 


£(tA)  -  h[x(tA)]  + 


(III-5) 


which  is  a  nonlinear  measurement  equation.  The  measurement  noise  v(t.) 
was  assured  to  be  zero  mean  white  Gaussian  discrete  time  noise  with  a 
diagonal  covariance. 
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Tracker  *1odel  For  Inertial  Filters 

A  tracker  with  the  same  characteristics  as  the  one  for  the  GMLCS 
filter  was  used  for  the  inertial  filters.  The  only  difference  was  that 
the  2 -axis  of  the  tracker  was  assumed  to  be  parallel  to  the  xb-yb  plane 
of  the  attacker  body  coordinate  frame  (See  Fig  III-3)  instead  of  the 
north-east  plane  of  the  earth-fixed  reference  frame  at  the  time  of  mea¬ 
surement  tj_.  The  attacker  body  coordinate  frame  had  the  origin  at  the 
center  of  gravity  eg  of  the  attacker  with  the  xb  axis  out  the  nose,  the 
yb  axis  out  the  right  wing,  and  the  zb  axis  down  through  the  fuselage. 

The  angles  n(tjc)  and  v  (tjc)  were  the  Euler  rotation  angles,  in  that 
order,  for  the  transformation  from  the  attacker  body  axis  frame  to  the 
tracker  (estimated  IDS)  coordinate  system.  The  angle  n ( ty c)  was  the 
angle  between  the  axis  and  the  projection  of  the  estimated  LOS  into 
the  xb-yb  plane  at  time  t£c.  The  angle  v(t^°)  was  the  angle  between 
the  projection  of  the  estimated  IDS  into  the  xb-yb  plane  and  the  estimated 
LOG  vector  at  time  The  use  of  the  attacker  body  frame  for  a  ref¬ 

erence  for  the  tracker  coordinate  system  was  cliosen  to  reduce  the  pos¬ 
sibility  of  a  singularity  in  the  Euler  angle  transformation  calculated 
by  the  estimator  since  the  attacker  aircraft  normally  would  be  maneuver¬ 
ed  to  keep  the  target  within  +_  90  degrees  of  the  xb  axis.  Hcwever,  the 
transformation  from  the  earth-fixed  reference  frame  to  the  attacker  body 
coordinate  system  at  time  ti  was  required.  This  transformation  would 
not  be  available  until  after  time  t^  if  taken  directly  from  the  IMU. 

For  this  thesis,  it  was  assumed  that  the  errors  in  this  coordinate  trans¬ 
formation  had  only  second  or  higher  order  effects  on  the  performance  of 
the  estimator.  Thus,  the  transformation  from  the  earth-fixed  reference 
system  to  the  attacker  body  frame  at  time  tj_  was  used  without  adding 
any  measurement  noise. 
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The  use  of  the  earth-fixed  reference  system  for  a  reference  for 
the  tracker  coordinate  frame,  as  was  done  for  the  GMLC6  filter,  eliminated 
the  need  for  the  transformation  from  the  earth-fixed  reference  frame  to 
the  attacker  body  axis.  However,  the  probability  of  having  a  singularity 
in  the  Euler  angle  transformation  calculated  by  the  estimator  was  great¬ 
er  for  this  method  than  for  the  method  used  for  the  inertial  filters. 


Measurements  For  The  Inertial  Filters 

The  measurements  assumed  to  be  available  from  this  tracker  were 
the  same  as  described  for  the  GMLCS  filter:  range  R,  the  tangents  of 
the  azimuth  and  elevation  error  angles  a  and  e,  respectively,  and  the 
range  rate  R.  (See  Fig  III-2)  As  before,  each  measurement  was  assumed  to  be 
made  by  an  independent  device  and  was  ooor dinat i zed  in  the  tracker  coordinate 
frame.  Thus,  the  measurements  at  time  ti  in  the  tracker  coordinate 
frame  were  given  by  Eqs  III-l  to  III-4.  However,  the  state  variables 
for  the  inertial  filter  were  defined  in  the  inertial  coordinate  system. 

Since 

-£  -  T  £  <*!>  Ei  <tA>  (III-6) 


where 


T^(tj)  =  the  transformation  from  an  earth-fixed 

L 

inertial  coordinate  frame  to  the  tracker 
(estimated  IDS)  coordinate  frame  at  time  t^ 
=  a  vector,  m,  ooor  dinati.  zed  in  the  earth- 
fixed  reference  frame  at  time  tj_ 

=  vector  m  coor  dinati  zed  in  the  tracker 
coordinate  frame  at  time  t^ 
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then  the  neaeerenents  defined  by  Dqs  III-l  to  III-4  were  written  as 

z1(ti,.R(t1,  *  w  t xT^(tli! *)H 


+  Vj.ft*) 


(III-7) 


t^V-tan  elt,)  *  V2  =-  ([rift,)]  „  [  [k^)]  32  [  ,W„. ,] 

*  [rflV]  33  [  X^/A^. ,]  7)y  ([*!,*.,]  ^  [  XT/A(ti,]  7 

* 1 &£  (tA2  f  xTf ' M  4*  <t. )]  j.  [  »V>lt.l]  7) 


*  V2  ,Ci> 


(III-8) 


Sjitjl-tan  ,(ti)  +  v3(ti)»(fri(t.)]21  [  xt/A(t.  ,1  7  +[ri(t.,]22  [XT/A(t.,] 
♦[ri(ti>]23  [xTf(t.)]7)/  ([ri(t.)]u 


z1(t1)-fl(t1)  ♦  Vjlti)  -  j([1xT(t1)]  2 )  [  x'lNtl]  3 
*(N(V]S  -  tM(ti)]2)[  X^A(t3,]4 

"(K’Ms  '  3)[  **'*(tl)]7  j 

/(  [  «TfM  *♦[  xVAj^,]  2*  [  XT/A(ti,j  2|  ■» 


♦  v,»V 


(III-10) 


where 


“  the  element  of  the  transformation 
from  the  earth-fixed  coordinate  system 
to  the  tracker  coordinate  system  at  time 
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The  transformation  T^(tj.)  was  calculated  by  transforming  the  relative 
position  state  estimates  at  time  t£  to  the  attacker  body  coordinate  frame 
vising 


ft* 


[iT/A(t  >] 

L  b  i  4 

[x%A(ti)]  7 

w 


’b'V 


4 

7 


(III-ll) 


where 


—  the  transformation  from  the  earth- fixed 

reference  frame  to  the  attacker  body 
coordinate  system  at  time  t^  assumed 

perfectly  available  from  the  IMJ. 


The  subscript  b  denotes  that  a  vector  was  coordinatized  in  the  attacker 
body  frame,  and  the  *  denotes  estimated  values  from  the  filter.  As 
discussed  before,  the  transformation  used  was  the  true  transformation 
available  from  the  trajectory  generating  program.  Then,  the  Euler  angles 
n (tjc)  and  v(tjc)  between  the  attacker's  body  coordinate  system  and  the 
new  estimated  ICS  based  on  the  filter’s  estimate  of  target  relative 
position  at  time  t^  (See  Fig  III-3)  were  calculated  from  the  position 
vector  defined  by  Eq  III-ll.  These  angles  were  assumed  to  be  bets-.c-en 
-90  degrees  and  90  degrees  as  discussed  before.  Therefore,  the  tangent 
relationships  given  by 


■>],) 

(III-12) 

(III-13) 
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were  used.  Once  the  angles  n(tjc)  and  v(tjc)  v;ere  calculated,  the 

transformation  T^(  tTC)  from  the  attacker  body  coordinate  frame  to  the 

L  1 

tracker  (estimated  LCS)  coordinate  system  was  found  using 

cri(tjC)Cv(tiC)  sn(t^c)cv(t^c)  -3v(t^c) 

TL(tIC)  “  -sn(tjc)  cn (trc)  0  (III-14) 

cn(tjc)  sv(t£c)  sn(t^C)  SV(tj_C)  CV(t^C) 

where  s  and  c  denote  sine  and  cosine  functions,  respectively.  (See 

Appendix  A  for  the  development  of  this  transformation.)  Finally,  the 

transformation  T^(t  )  reouired  for  the  measurement  equations  was  cal- 
L  i 

culated  from 

T^(t.)  «■  'r^(t?c)T5(t  )  (III-15) 

L  1  L  1  b  1 

As  with  the  tracker  for  the  Gvtt£S  filter,  the  measurements,  Eqs 
III-7  to  III-10,  can  be  written  in  the  form  of  Eq  III-5,  a  nonlinear 
vector  measurement  equation. 

Selection  of  Tracker  Measurement  Noises 

The  noises  to  be  added  to  the  true  measurements  were  assured  to 
have  the  same  statistical  characterization  for  each  tracker  model  since 
the  same  quantities  were  measured.  The  value  of  the  variance  of  the 
noise  for  each  measurement  was  based  upon  the  capabilities  of  trackers 
in  current  fighter  aircraft  (Ref  4) .  The  probability  distribution  of 
the  error  in  the  measurement  was  assumed  to  be  well  represented  by  a 
Gaussian  distribution  with  a  mean  of  zero.  Also,  since  each  measurement 
was  made  by  an  independent  device,  there  were  no  noise  cross  correlations. 
Thus,  the  measurement  noises  were  characterized  by  a  Gaussian  distribu¬ 
tion  with  the  properties 
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► 


E[v(t)]s  0 

and 


where 


(III-16) 


(III-17) 


5i3 


0  i/j 
1  i=j 


Hie  covariances  of  the  measurement  noise  R(tj_)  were  defined  by 


R(t±) 


*  R(ti>  0 


a2e(t.) 


0  a(ti}  0 


a2R{ti} 


(III-18) 


The  quantities  c~B(tj),  a2  (t.),  cr2  (t.),  and  o2'(t. )  were  the  variances 
of  the  range,  tangent  of  the  error  angle  e,  tangent  of  the  error  angle  a, 
and  range  rate  measurement  noises. 

For  the  range  measurement,  the  tracker  was  assumed  to  provide 
measurements  with  +  300  feet,  which  was  considered  a  3  sigma  value. 
Therefore,  the  1  sigma  value  oR  was  +  100  feet.  The  variance  of  the 
range  measurement  noise,  o2^,  was  calculated  fran 


o2r  »  (100  feet}2  *  10000  feet2 


(m-19) 


The  tracker  was  assumed  to  measure  the  tangent  of  either  error 
angle  to  within  +  0.030  radians  (+  1.72  degrees).  Again,  this  was  con¬ 
sidered  a  3  sigma  value;  the  1  sigma  value  ce  or  oa  was  +  0.010  radians. 
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Thus,  the  variances  a2e  and  a2a  for  the  measurement  noise  of  the  tan¬ 
gents  of  the  error  angles  e  and  a  were  calculated  from 


o2e  =  (0.010)2  =  0.0001 


(III -20) 


and 


o2a  =  (0.010)2  =  0.0001 


(III-21) 


Finally,  the  range  rate  measurement  was  assumed  to  be  accurate 
within  +  75  feet  per  second.  This  gave  a  variance  a^2  for  the  range 
rate  measurement  noise  calculated  from 

a2  A  =  (25  feet/second) 2  =  625  feet2/second2  (III-22) 

A  summary  of  the  values  for  o2R,  a2e,  a2e,  and  o2R  is  presented  in 
Table  III-l.  These  values  were  used  as  the  baseline  for  the  variance 
of  the  measurement  noises. 
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TABLE  III-l 


Measurement  Noise  Variances  for  Tracker  ‘todels 


Measurement 

Three  Sigma 

Value  for  Error 

Value  Used  in  R  Matrix 

Range 

300  feet 

10000  feet2 

Tan  e 

0.030 

0.0001 

Tan  a 

0.030 

0.0001 

Range  Rate 

75  feet/second 

625  feet2/second2 
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IV  Extended  Kalman  Filter  Implementation 


Extended  Kalman  Filter 

The  extended  Kalman  filter  approximation  for  the  nonlinear  filter 
was  chosen  since  a  new  reference  state  trajectory  for  linearization  would 
be  used  each  time  new  state  estimates  were  calculated,  and  the  complexity  ‘f 
of  the  solution  was  significantly  less  than  other  higher  order  methods 
available.  The  use  of  a  new  reference  state  trajectory  for  lineariza¬ 
tion  provided  performance  that  was  far  superior  to  a  linearized  Kalman 
filter  since  the  nominal  trajectory  for  an  air-to-air  tracking  task 
was  not  known  a  priori.  Further,  the  extended  Kalman  filter  was  oom- 
pa table  with  a  previously  written  simulation  program  used  to  evaluate 
Kalman  filters  (Ref  5) .  The  equations  (Ref  3)  for  the  propagation  of 
the  state  estimates  and  the  propagation  of  the  conditional  covariance 
of  the  dynamics  modeled  by  Eq  11-43  and  measurements  modeled  by  Eq  III-5 
were 


xtt/ti)  .  f  [xU/tj.)] 

(iv-1) 

-  r[x(t/ti)]  P(t/ti)  +  Pft/t^Ff  x(t/tA)]  +  Q(t) 

(rv-2) 

The  update  equations  for  the  state  estimates  and  conditional  covariance 

were 

K(tA)  - 

P(t")HT[i(t-)j  [  HrLx(t")]  P(t~)HT[x(tp]  +  RCt^j 

(IV-3) 

i(t*>  -  x(t“)+K(ti)  j  zU^-hJxttT)]  j 

(IV-4) 

p(t*>  -  p(ti?-:<(ti)H[i(t“)]  p(tj) 

(rv-5) 
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where 


and 


and 


x(t/t^)  =  state  estimate  at  time  t  for  tt(tj_,  t^+i) 

based  on  the  initial  conditions  x(tj/ti)=x(t[) , 
i.e. ,  on  measurements  through  time  t^ 

[A  1 

^rr^a^ics  model  as  a  function  of 

xtt/t^ 

p (t/t*)  -  filter's  conditional  error  covariance 
matrix  at  tine  t  based  on  the  initial 
condition  P(t^/t^}=F(tt) /  i.e.,  on 
measurements  through  time  tj_ 

Q(t)  »  the  descriptor  of  the  strength  of  the 
dynamic  driving  noise  vector,  w(t) ,  at 
time  t 

p(t~)  =  filter's  conditional  covariance  matrix 
just  before  the  update  time  tj_ 

K(t^)  =  filter's  gain  matrix  at  time  t^ 

H(t^)  =  oovarianoe  matrix  of  measurement  noises 
z  (t^)  =  true  measurement  vector  at  time  t^ 

=  measurement  model  vector  evaluated 
using  x(t7) 
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Note  that  the  dynamic  driving  noise  vector  w(t)  was  assumed  to  be  a 
zero  mean  white  Gaussian  noise  (as  described  in  Section  II)  with 
covariance  given  by 

E  [w(t),wT(t+T)]  =  Q(t)  <5(t)  (IV-8) 

Extended  Kalmar.  Fi  Iter  for  Gauss -Markov  Line  of  Sight  Model 

The  implementation  of  the  CMOS  model  in  the  extended  Kalman  filter 
required  not  only  the  calculation  of  the  F  and  H  matrices,  but,  also  the 
transformation  of  the  state  estimates  and  the  filter's  conditional  co- 
variance  at  time  t7c  to  the  new  filter  coordinate  frame  calculated  frcm 
the  position  state  estimates  at  time  £[c.  The  calculation  of  the  F  matrix 
for  the  O4L0S  dynamics  model  (Eq  11-12)  was  straightforward  since  the 
dynamics  model  described  a  linear  stochastic  system.  Using  Eq  IV-6,  the 
F  matrix  for  the  GMDQS  dynamics  model  was 
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Note  that  the  correlation  time  constants  were  assumed  to  be  time  in¬ 


variant  since  the  target's  acceleration  probability  distribution  was 
assumed  constant  with  time  (i.e. ,  the  target's  conf irguration  did  not 

change  during  the  engagement)  .*  Also,  the  coorelation  time  constants 
were  assumed  to  be  equal  since  out-of -plane  tracking  was  anticipated. 
(Note  that  when  in-plane  tracking  is  anticipated,  the  correlation 
time  constants  are  not  assumed  to  be  equal.) 

The  calculation  of  the  H  matrix  was  more  difficult  since  the 
measurement  model  for  the  (34LCS  filter  was  nonlinear.  Using  Eq  IV-7, 
the  H  matrix  for  the  tracker  measurement  model  used  with  the  GMLC6 


filter  (Eqs  III-l  to  III-4)  was 


where 


H[x(t")] 


H.  0  0  H.  0  0  H,  0  0 


H.  00000  H.  00 


H*  00  H,  00000 


H8  H9  0  H10  H11  0  H12  H13  0 


(IV-10) 


*»x(t£) 


Sl  ■  ■ 


H- 


L  L  J4 


41 


[‘YM, 

[»Vw]| 


[-?««»>]  J 


H- 


[xT'Nv] 

L  L  1  J1 


-  [ -Y(ti>]  4  P-Y“*  J  5+  tY<y  >]  7  P»Y«*i)] ,)  I 


/.(D^Ctt)]  1 4  [xf/A(t.  ,]  K  txT<i'<ti)]  ]  ) 


3/, 


[«Y<h>] 


H. 


(  [xT£A(ti)]  [xT£A(ti)]  \  [xT£A(ti)]  ^ 
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([-7 «*!>]?)' 

«u  -  !  [Vf  <ti>]  „  ([*Tf  M  ’♦  [*Tf  <tl)]  [xTf  <tt)]  2,| 

-[*,f‘ti)]7([*Tf(‘i»]1[I’'If<H>]2 

*  [*Tf (ti>]  rrxTf ( w] 7[Vf <hi] „)! 

L  4  1#  51#  7  L  8 

/([x^tVl  2+tT/-A(ti)]  2+[xT/A(ti)]  2  )  V2 

L  XL  4  L  7 


The  trans formation  of  the  state  estimates  from  the  current  filter's 

A  A 

coordinate  frame  Lc  at  time  tj°  to  the  new  coordinate  frame  1^  at  time  tjr 
based  on  the  position  state  estimates  at  was  accortplished  by 
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(IV-11) 


where 


x»  (t£r)  =  T«C(t£)x-  (t£c) 


T11  0  0  T15  0  0  T.,  0  0 


0  TU  0  0  0  0  T130 


0  0  TU  0  0  T,2  0  0  T. 


T21  0  0  T„  0  0  T23  0  0 


T*te(tr) 
*  I 


0  T„  o  o  0  0  T__  0 


o  o  t21  o  o  t22  0  o  t23 


Tjl  0  0  T32  0  0  T33  0  0 


o  t31  o  o  t32  0  o  r33  o 


0  o  t31  0  o  t32  0  o  t33 


and  is  the  ij^1  element  of  the  transformation  Tfc(ti)  from  the  current 

Ln 

OILOS  coordinate  system  to  the  new  coordinate  system.  Now, 


-  T*  (ti)TLc(tt) 
1 


(IV- 12) 


where 


T£c(t~) 


the  inverse  of  the  transformation 

from  the  earth-fixed  coordinate  system  to 

the  GMLCS  filter's  coordinate  frame  at 


time  tj 


44 


T»  (t7)  *=  the  transformation  from  the  earth-fixed 
hx  l 

reference  frame  to  the  O^LOS  coordinate 
frame  based  on  the  position  state  esti¬ 
mates  at  t£ 

These  transformations  are  discussed  in  more  detail  later  in  this  section. 

The  filter's  conditional  covariance  matrix  P(t£)  was  transformed 
from  the  current  GMLCS  coordinate  frame  to  the  new  frame  using 

A  A 

P*  (tTr)  e  T^c{tT)P.  (tTc)T^c(t7)T  (IV-13) 

hx  1  h  1  Lc  X  1 

This  equation  was  developed  fran  the  definition  of  the  conditional 
covariance  e:<pressed  in  the  current  coordinate  frame  given  by 


p-  (t;c) 
^  i 


(IV- 14) 


where 


=  the  random  vector  representing  the  entire 
measurement  history  at  time 
?i-l  *  realized  measurement  values  at  time 
for  a  single  trial 

Likewise,  the  conditional  covariance  in  the  new  coordinate  frame  was 
expressed  as 


(IV- 15) 


substituting  Eq  IV- 11  into  Eq  17-15 ,  and  noting  that 


x*  (t, )  »  T^(t7)x-  (t. ) 

1  %  1  T*  1 


(IV-16) 
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then 


^(ti)T|B(ti_i)=gi_ij 


(IV- 17) 


Now,  since  the  transformation  was  a  deterministic  function  of  the 
realization  Z Eq  IV-17  was  written  as 


Pfn(tIr)  "  T^{tI)^L^(ti)^Lc(tr)]fec(ti)-4c(^C)]' 

% 


(IV-1S) 


vhich  became  Eq  TV-13  when  Eq  TV-14  was  substituted  into  Eq  TV- 18. 

As  stated  earlier,  the  transformation  T£^(tJ)  was  calculated 
using  Eq  IV-12.  Since  -the  G4L0S  filter's  coordinate  frame  was  assured 
to  be  space-stabilized  from  to  tT°,  the  transformation  T^c  ( t~)  was 

A 

the  inverse  of  the  transformation  T^p.  (tj_y)  >  which  was  calculated  after 
the  impulsive  rotation  but  before  the  measurement  update  at  tine  t7^. 
The  second  transformation  (t£)  required  to  evaluate  the  transforma- 
tion  T^(tJ)  was  calculated  frcm  the  position  state  estimates  ooordi- 
natized  in  the  earth- fixed  reference  system  at  time  t£°  given  by 


[*W>]  t 

x> 

[*T(A«=ic>]  4 

-  TLc(t“) 

r  -t/a 
X 

(tl0)] 4 

(TV-19) 
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The  sine  and  cosine  of  the  Euler  rotation  angles,  n(tj)  from  the  north 
axis  of  the  earth-fixed  reference  frame  to  the  projection  of  the  new 
ICG  in  the  north-east  plane  of  the  earth-fixed  reference  frame  and 
v(tT)  from  the  projection  of  the  new  ICS  in  the  north-east  plane  to  the 
estimated  LCS  (See  Pig  IV- 1)-,  v/ere  calculated  from 


[iT<tic>] 


sin  n(t£c)  « 


(IV- 20) 


cos  n(tjc>  = 


(IV-21) 


[;T^A(tici] 


sin  v(t£c)  * 


(IV-22) 


COS  V(t£C)  a 


1  4 


2\  h 


(IV-23) 


( Of  up] \*  [*f  >]  t  [i^A(t-=)]  *)*■ 


Cnee  the  sine  and  cosine  values  were  calculated,  the  transformation 
T^(t£)  was  evaluated  using 


T-  (tl)  - 


cn(tjc)cv(ti°)  sn(t][c)cv{t£c)  -sv(tic) 
-sn(tjc)  cn(tjc)  o 

cn(t£C)sv(tjc)  sn(tic)  svt^®)  cv(t£c) 


(TV-24) 


(See  Appendix  A  for  development  of  this  transformation.) 
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The  timing  of  the  events  for  the  GMLOS  extended  Kalman  filter 
is  shown  in  Fig  IV-2,  and  the  block  diagram  is  depicted  in  Fig  IV-3. 


pagated  forward  in  time  to  time  trG  j.n  the  current  estimated  LOS  co- 

A 

ordinate  frame  (I^)  .  At  time  tj_ ,  the  state  estimates  and  conditional 

covariance  were  sampled,  and  the  transformation  frcxn  the  current 

In 

estimated  LCS  (filter's)  coordinate  frame  Lc  to  the  new  estimated 
(filter's)  coordinate  frame  was  calculated.  This  transformation 
was  used  to  realign  the  tracker,  and  both  the  state  estimates  and  con¬ 
ditional  covariance  were  expressed  in  the  new  coordinate  system.  Then, 
the  estimates  of  the  measurements  were  calculated  from  the  state  esti¬ 
mates,  the  Kalman  filter  gain  K(tj_)  was  calculated  from  the  conditional 
covariance,  and  the  conditional  covariance  update  was  performed.  Finally, 
the  measurement  residuals  were  calculated,  multiplied  times  the  Kalman 
filter  gain,  and  summed  with  the  state  estimates  to  generate  the  state 
estimates  after  the  measurement  update  at  time  t£. 

Extended  Kalman  Filter  for  Gauss-Markov  Inertial  Model 

The  implementation  of  the  <241  extended  Kalman  filter  required  only 
the  evaluation  of  the  F  and  H  matrices  since  the  coordinate  frame  was 
not  rotated  to  a  new  position  at  time  tj  as  was  the  coordinate  frame 
for  the  (ULCS  filter.  Like  the  GMLOS  model,  the  calculation  of  the  F 
matrix  was  straightforward  since  the  dynamics  were  represented  by  a 
linear  stochastic  model.  Using  Eq  IV-6,  the  F  matrix  for  the  GMI  dynamics 
model  was  given  by  Eq  IV-9.  Again,  the  correlation  time  constants  were 
assumed  to  be  time  invariant  and  equal  since  the  target  was  assumed  to 
have  the  same  acceleration  capability  along  any  axis. 

The  calculation  of  the  H  matrix  for  the  GMI  model  from  Eqs  II1-7 
to  III-10  was  more  difficult  and  involved  two  approximations  in  the  two 
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of  Tvruns 


<ti)  ■ 


Figure  IV-3.  Block  Diagram  for  GMLOS  Extended  Kalman  Filter 


angle  measurements.  Since  the  measurements  of  the  tangent  of  the  error 
angles  a  and  e  involved  the  transformation  from  the  earth-fixed  to 
the  tracker  coordinate  system,  and  this  transformation  was  a  function 
of  the  position  states,  the  fully-expanded  H  matrix  required  the  partial 
derivative  of  the  transformation  matrix  with  respect  to  the  state  vector. 
However,  the  terms  involving  the  partial  derivatives  of  the  transforma¬ 
tion  were  assumed  small  when  carpared  with  the  other  terms  (See  Ref  6) 
and  were  ignored  for  the  evaluation  of  the  H  matrix  for  the  inertial 
filters  evaluated  in  this  thesis.  Also,  the  denominator  of  Eqs  III-8 
and  III-9  were  assumed  constant  (Ref  6) .  With  these  assumptions,  the 
H  matrix  became 
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was  the  magnitude  of  the  position  estimate  along  the  1-axis  of  the 
tracker's  (estimated  ICS)  coordinate  frame. 

As  discussed  in  Section  III,  the  tracker  was  pointed  along  the 
new  estimated  LOS  calculated  from  the  position  estimates  at  time  tlc. 
The  timing  sequence  used  for  the  ©n  extended  Kalman  filter  implementa¬ 
tion  is  summarized  in  Fig  IV-4,  and  the  block  diagram  is  presented  in 
Fig  IV-5.  The  state  estimates  x^- (t)  were  propagated  forward  in  tins 
to  time  ti  when  the  state  estimates  were  sampled.  The  state  estimates 
Xj(tJ)  at  time  tj  were  used  to  calculate  the  estimates  of  the  measure¬ 
ments  frcm  the  vector  h]x(t7)j  and  the  transformation  T?  (t)  for  the 
tracker  (as  discussed  in  Section  III) .  The  measurement  residuals  were 
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Figure  TV-5.  Block  Diagram  for  GMI  and  CTRL  Extended  Filters 


formed  and  multiplied  by  the  Kalman  filter  gain  K(tp  calculated  from 
the  propagation  of  the  conditional  aovariance  P(tT)  at  time  tr.  This 
product  was  sinned  with  the  state  estimates  Xj(tp  to  calculate  the 
state  estimates  Xr  ( t£)  used  for  the  initial  conditions  of  the  next  pro¬ 
pagation  interval. 

Extended  Kalman  Filter  for  Constant  Turn  Rate  Inertial  Model 

As  with  the  CMI  dynamics  model,  implementation  of  the  CTRI  dynamics 
model  in  the  extended  Kalnan  filter  required  only  the  evaluation  of  the 
F  and  H  matrices  since  the  filter's  coordinate  frame  did  not  rotate. 
However,  unlike  the  GG  model,  the  calculation  of  the  F  matrix  was  not 
trivial  since  the  dynamics  model  for  the  CTRI  filter  was  nonlinear.  Using 
Eq  IV-6,  the  F  matrix  for  the  CTRI  model  was 
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The  H  matrix  for  the  CTRI  model  was  the  same  as  the  one  used  for  the  GM I 
model  since  the  trackers  and  state  variables  were  the  same  for  both 
filters.  The  H  matrix  was  given  by  Eq  IV-25.  Also,  the  timing  sequence 
and  the  block  diagram  for  the  CTRI  model  were  identical  to  those  of  the 
CMC  model  and  are  presented  in  Fig  IV-4  and  Fig  IV-5,  respectively. 


Selection  of  Parameters  for  Extended  Kalman  Filters 

The  parameters  for  the  extended  Kalman  filters  for  the  GMLOS  and 
GMI  model  that  had  to  be  selected  were  the  correlation  time  constants 
Tj,  and  and  the  descriptor  Q  of  the  strength  of  the  filter's  dynamic 
driving  noise.  The  correlation  time  constants  were  assumed  to  be  equal 
for  all  three  axes  of  the  filter's  coordinate  system  as  discussed  earlier 
in  this  section.  The  value  for  the  time  constants  was  selected  to  provide 
a  reasonable  frequency  band  for  the  paver  spectral  density  of  the  correlated 
acceleration.  For  high  performance  aircraft,  a  reasonable  upper  frequency 
for  the  correlated  acceleration  was  assumed  to  be  three  radians  per  second 
(Ref  7) .  This  value  of  upper  frequency  corresponded  to  a  correlation  time 
constant  of  two  seconds . 
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The  values  for  the  elements  of  the  Q  matrix  defined  by  5q  IV-8  were 
selected  for  the  GMLOS  and  OH  filter's  by  performing  a  steady  state 
analysis  for  the  filter's  conditional  covariance  matrix  P(t) .  It  was 
assumed  that  the  driving  noises  were  white  Gaussian  zero  mean  noises. 
Further,  the  Q  matrix  was  assumed  to  be  of  the  form 


where  q^  =  the  i**1  nonzero  element  of  the  Q  matrix.  This  form  was  used 
since  it  was  assured  that 

E  j Wi (t)wj (t+T)j  =0  (IV-28) 

for  all  t  and  t,  a  standard  assumption  for  the  driving  noises  used  for 
filter  inplementation  (i.e. ,  no  correlation  between  the  dynamic  driving 
noises) .  For  the  steady  state  filter  conditional  covariance  analysis, 
the  Eq  IV-2  for  the  propagation  of  the  filter's  covariance  was  used.  In 
steady  state,  this  equation  was  written  as 
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Since  the  dynamics  model  for  either  the  CMLOS  or  the  GMI  filter  were 
decoupled  along  each  axis,  only  the  dynamics  equations  along  the  1-axis 
were  evaluated  to  calculate  the  element  of  Q.  Also,  the  values  of  the 
nonzero  elements  of  the  Q  matrix  were  equal  since  the  correlation  time 
constants  were  assumed  to  be  equal.  Equation  IV- 29  became 
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where 


0  0  '  0 
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=  ij**1  element  of  the  filter's  covariance 
matrix  in  steady  state  operation 
Evaluation  of  the  33^  element  gave 
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T 


P33  = 


(IV-31) 


The  value  used  for  the  filter's  covariance  of  the  target  acceleration  along 
the  one  axis  P33  was  calculated  based  on  the  assumption  that  the  3  sigma 
values  of  the  error  in  the  target  acceleration  estimate  was  9  g's,  or  about 
290  feet  per  second2.  Thus,  the  1  sigma  value  was  3  g's,  or  approximately 

97  feet  per  seond  ,  and  the  value  of  element  P33  was  calculated  to  be  9409 

7  a  2  4. 

feet  per  second4.  This  value  of  9409  feet  per  second  was  substituted 

2  5 

into  Eq  IV-31,  yielding  a  value  of  q^  of  9409  feet  per  second  when  a 
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correlation  time  constant  of  2  seconds  was  used.  For  the  implementation 

2  5 

of  the  OILOS  and  GMI  filters,  a  value  of  9000  feet  per  second  was  selected. 

For  the  CTRI  extended  Kalman  filter,  only  the  value  of  the  nonzero 

elements  of  the  Q  matrix  had  to  be  selected.  However,  since  this  filter 

used  a  nonlinear  dynamics  nodel,  the  steady  state  conditional  covariance 

analysis  could  not  be  used.  The  method  of  selecting  the  values  of  the 

Q  matrix,  which  was  assumed  to  have  the  form  shown  in  Eq  IV-27,  was  by 

2  5 

trial  and  error.  Initially,  a  value  of  32  feet  per  second  was  chosen 
for  the  q's,  which  represented  a  1  sigma  value  of  about  0.2  g's;  but 
this  value  was  too  small  to  provide  adequate  performance  for  trajectories 
with  high  target  acceleration  variations.  Ntext,  a  10  fold  increase  in 
the  1  signs  value,  i.e.,  a  value  of  3000  feet^  per  second"*,  was  tried;  and 

2 

the  performance  was  significantly  improved.  Finally,  a  value  of  9000  feet 
per  second5,  representing  a  1  sigma  value  of  about  3  g’s,  was  evaluated. 

This  was  the  value  used  in  the  CTRI  filter  since  it  provided  good  performance 
for  the  filter  when  evaluated  against  the  trajectories  used  for  this  thesis 
and  permitted  the  CTRI  and  GMI  filter’s  performance  to  be  compared  with  the 
same  Q  matrix.  The  use  of  the  same  Q  matrix  implied  that  the  same  order 
of  uncertainty  or  variations  of  the  filter's  estimate  of  the  trajectory  was 
assumed  for  both  the  constant  turn  rate  trajectory  computed  by  the  CTRI 
filter  and  the  Gauss-Markov  zero  mean  acceleration  trajectory  calculated 
by  the  GMI  filter. 
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V  Method  of  Evaluation 


Monte  Carlo  Simulation 

A  modified  version  of  the  generalized  digital  Simulation  for 
Optimal  Filter  Evaluation  (SOFE)  program  developed  at  the  Air  Force 
Avionics  Laboratory  (Ref  5)  was  used  to  test  each  filter's  performance . 

The  SOFE  program  provided  the  basic  functions  needed  to  run  Monte  Carlo 
simulations  of  an  extended  Kalman  filter.  These  functions  included  a 
numerical  solution  to  the  differential  equations  for  both  system  simula¬ 
tion  and  filter  propagation,  a  Carlson  square  root  update  of  the  filter's 
state  estimates  and  conditional  covariance,  and  the  necessary  program 
control  for  multiple  simulations.  Nine  user  written  subroutines  were 
required  to  define  both  the  system  simulation  and  the  Kalman  filters. 

For  this  evaluation,  the  system  simulation  was  provided  from  external 
trajectory  data  (to  be  discussed  later  in  this  section) .  Equations  II -11, 
III-l,  III-2 ,  III-3,  III-4,  IV-9,  and  IV-10;  33qs  n-23,  III-7,  III-8, 

III- 9,  III-10,  IV-9,  and  IV-25;  and  Eqs  11-42,  III-7,  III-8,  III-9,  III-10, 

IV- 26,  and  IV-25  were  included  in  the  user  written  subroutines  to  specify 
the  filter  model  for  the  QHjOS,  GMI,  and  CTRI  filter,  respectively.  The 
outputs  of  the  SOFE  program,  the  true  model  state  vector,  the  filter's 
estimate  of  the  state  vector,  the  measurement  residual  vector,  the  measure¬ 
ment  residual  variances,  and  the  filter's  variances  for  each  interval 
were  stored  for  post-processing  by  the  SOFE  plotting  (SorePL)  program 

(Ref  8) ,  also  developed  by  Air  Foroe  Avionics  laboratory  personnel. 

The  number  of  simulation  passes  through  the  simulation  for  each  filter 
evaluation  used  for  this  thesis  was  20.  This  number  of  passes  was 
selected  by  comparing  plots  from  the  SOrePL  program  for  5,  10,  15,  and 
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20  passes  (Fig  B-l  to  Fig  B-9,  Fig  B-10  to  Fig  B-18,  Fig  B-19  to  Fig  B-27, 
and  Fig  E-10  to  Fig  E-18,  respectively) .  There  was  little  difference 
between  the  plots  for  15  and  20  passes,  and  20  passes  were  selected  to 
provide  confidence  in  the  accuracy  of  the  solution.  Also,  the  choice  of 
20  passes  kept  computer  execution  tine  and  storage  requirements  at  accept¬ 
able  values. 

As  stated  above,  a  modified  SOFE  program  was  used  for  the  evalua¬ 
tion.  Two  modifications,  a  second  order  Runge-Kutta  integration  option 
with  fixed  step  size,  instead  of  the  fifth  order  Runge-Kutta  integration 
provided  by  the  SOFE  program,  and. the  use  of  external  trajectory  data 
for  the  true  state  vector,  instead  of  the  SCFE  program  calculating  the 
true  state  vector  during  the  simulation,  had  been  previously  incorporated  by 
Air  Force  Avionics  Laboratory  personnel  (Ref  9) .  These  two  modifications  re¬ 
duced  the  computational  burden  required  to  perform  the  integration  from 
time  tt  to  time  tj+1,  thus  reducing  the  time  required  for  the  20  Monte 
Carlo  simulations.  Also,  a  third  modification  to  the  SCFE  program  was 
made  for  the  GMLOS  filter  to  allow  the  transformation  of  the  filter's 
conditional  covariance  matrix  P(tp  from  the  filter's  current  coordinate 
frame  at  time  ty°  to  the  realigned  coordinate  frame  at  time  tTr  as 
described  in  Section  III. 

The  SOFEPL  program  calculated  the  ensemble  average  of  the  data 
from  the  multiple  Monte  Carlo  simulations  from  the  SOFE  program  and 
formatted  these  results  into  the  requested  plots.  Sixteen  different 
plot  types  were  available  fran  the  SOFEPL  program.  For  this  thesis,  the 
mean  error  between  the  truth  model  (target  trajectory  data)  value  and 
the  corresponding  estimate  fran  the  filter,  the  sum  and  the  difference 
of  the  standard  deviation  of  this  error  with  the  mean  error  itself,  and 
the  square  root  of  the  appropriate  diagonal  element  of  the  filter's 
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conditional  state  covariance  matrix  were  plotted  versus  time  (See  Fig  V-l)  . 
This  plot  type  provided  the  sample  statistics  for  actual  errors  comitted 
by  the  filter  (mean  error  and  mean  error  plus  or  minus  the  standard  devia¬ 
tion  of  the  error)  and  the  filter's  computed  performance  (plus  or  minus 
the  square  root  of  the  filter's  conditional  variance)  to  evaluate  filter 
tuning  and  performance. 

Trajectory  Generation  and  Description 

The  trajectories  used  in  the  evaluation  of  the  three  filters  were 
generated  by  a  program,  TRAJ,  developed  by  Air  Force  Avionics  laboratory 
personnel,  to  provide  date  for  both  the  target  and  attacker  during  a 
dunnery  pass  (Ref  9)  .  The  program  allowed  the  user  to  fly  the  target  through 
a  maneuver  by  varying  the  thrust,  roll  rate,  and  normal  acceleration  while 
the  attacker  tracked  the  target  using  a  gunnery  lead  collision  scheme. 

The  outputs  of  the  program  which  were  calculated  every  0.02  seconds  (50 
times  per  second)  included  the  time,  position,  inertial  velocity,  and 
inertial  acceleration  of  both  the  target  and  the  attacker  in  an  earth-fixed 
reference  frame  and  the  transformation  from  the  earth-fixed  reference  frame 
to  the  attacker  body  coordinates.  The  origin  of  the  earth-fixed  reference 
frame  was  located  on  the  surface  of  the  earth  with  the  attacker's  center 
of  gravity  eg  on  the  negative  down  asix  at  the  initial  time  (Fig  V-2)  . 

Three  trajectories,  picked  to  represent  typical  target  maneuvers 
during  an  aerial  gunnery  engagement,  were  developed  using  the  TRAJ  pro¬ 
gram.  Each  engagement  lasted  12  seconds,  providing  adequate  time  for  the 
performance  evaluation  of  the  filters. 

Trajectory  1  was  selected  to  demonstrate  the  performance  of  each 
filter  against  a  target  flying  a  oonstant  normal  acceleration  maneuver. 
Initially,  the  target  and  attacker  were  flying  on  the  same  heading  parallel 
to  the  north  axis  of  the  earth-fixed  reference  frame  at  the  same  altitude 
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Figure  V-l.  Representative  Output  From  the  SOFEPL  Program 


of  5000  feet.  The  target  was  7500  feet  in  front  of  the  attacker  and 
offset  2000  feet  to  the  attacker ' s  right  (See  Fig  V-3) .  The  initial 
speed  of  the  target  was  800  feet  per  second  (approximately  500  knots) , 
and  the  initial  speed  of  the  attacker  was  750  feet  per  seoond  (approxi¬ 
mately  440  knots) .  Furthermore,  the  target  was  established  in  a  5g 
normal  acceleration  level  left  turn  (approximately  78  degrees  left  bank) . 
For  the  duration  of  the  trajectory,  12  seconds,  the  target  maintained 
the  5g  constant  normal  acceleration  left  turn. 

Trajectory  2  provided  a  highly  dynamic  maneuvering  target  with 
out-of -plane  maneuvers  to  evaluate  the  filters'  performance,  and  it  was 
designed  to  represent  a  typical  target  reversal  and  dive  out  of  the 
engagement.  The  target  and  attacker  had  the  same  initial  conditions  as 
in  Trajectory  1  except  the  initial  altitude  of  both  was  10000  feet  (See 
Fig  V-4)  .  For  the  initial  five  seconds ,  the  target  performed  the  same 
five  g  normal  acceleration  level  left  turn.  Then  the  target  initiated 
a  one  radian  per  seoond  roll  to  the  right  while  maintaining  five  g's 
normal  accelration.  The  roll  continued  until  the  target  was  inverted 
with  wings  parallel  to  the  north-east  plane  of  the  earth-fixed  reference 
frame  (wings  level) .  The  roll  rate  was  then  set  to  zero,  the  normal 
acceleration  was  increased  to  seven  g's,  and  the  target  completed  a 
"split  s"  maneuver  to  upright  level  flight. 

Trajectory  3  was  chosen  to  demonstrate  the  filters'  performance 

for  a  nose-to-nose  (front)  engagement.  The  engagement  was  designed  to 

represent  a  typical  front  engagement  where  the  target  attempts  to  gain 

a  firing  position  behind  the  attacker.  Initially,  the  target  and  attacker 

were  flying  with  wings  level  on  opposite  headings  parallel  to  the  north 

axis  of  the  earth-fixed  reference  frame.  The  target  was  15000  feet  in 

front  of  the  attacker  and  2000  feet  to  the  attacker's  right  (See  Fig  V-5) . 

Both  the  target  and  the  attacker  were  at  the  same  altitude,  5000  feet, 
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Attacker's  Center  of  Gravity 


Figure  v-3.  Initial  Positions  and  Velocities  For  Trajectory  1 
Relative  to  the  Earth-Fixed  Reference  Frame 


Attacker's  Center  of  Gravity 


Figure  V-4.  Initial  Positions  and  Velocities  For  Trajectory  2 
Relative  to  the  Earth-Fixed  Reference  Frame 


Attacker’s  Center  of  Gravity 


Figure  V-5.  Initial  Positions  an<\  Velocities  Fbr  Trajectory  3 
Relative  to  the  Earth-Fixed  Reference  Frame 


and  same  speed,  800  feet  per  second  (approximately  475  knots) .  Four 
seconds  after  the  start  of  the  engagement,  the  target  established  a  4g 
normal  acceleration  climbing  left  turn  which  was  held  for  4.5  seconds’. 

Then  the  target  rolled  right  at  one  half  radian  per  second  while  main¬ 
taining  four  g's  normal  acceleration.  Once  the  target  obtained  75 
degrees  of  right  bank  angle,  the  roll  rate  was  set  to  zero,  and  the 
target  continued  in  a  4g  normal  acceleration  level  right  turn  until  the 
end  of  the  engagement. 

Measurement  Update  Rates 

The  baseline  update  rate  selected  for  the  comparison  of  the  three 
filters  was  25  times  per  second  (0.04  seconds  between  updates).  This 
rate  was  selected  since  it  was  ccmpa table  with  the  time  increment  of  the 
trajectory  generating  program  and  was  oonsistant  with  measurement  rates 
available  from  current  sensors  (Ref  4) .  To  evaluate  the  sensitivity  of 
the  CTRI  filter  to  variations  in  update  rate,  update  rates  of  12%  times 
per  second  (0.08  seconds  between  updates) ,  6h  times  per  second  (0.16 
seconds  between  updates) ,  and  3  1/8  times  per  second  (0.24  seconds 
between  updates)  were  selected.  Faster  update  rates  were  considered  but 
conputer  storage  requirements  prohibited  the  evaluation  of  these  rates. 

Hie  descriptor  of  the  strength  of  the  dynamic  driving  noise  Q  was  held 
constant  during  this  evaluation.  Table  V-l  summarizes  the  update  rates 
used  with  each  filter. 

Variations  in  Measurement  Noises 

The  baseline  values  used  for  the  elements  of  the  noise  covariance 
matrix  R  (as  discussed  in  Section  III)  for  the  filter  only  were  varied 
systematically  to  evaluate  the  effect  on  the  CTPI  filter's  performance  when 
flown  against  Trajectory  2.  The  value  of  each  variance  was  independently 
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increased  and  decreased  by  an  order  of  magnitude  for  both  the  range  and 
range  rate  measurements.  For  the  error  angle  measurements,  the  varianoes 
of  both  error  angle  measurements  v/ere  increased  and  decreased  by  an 
order  of  magnitude  concurrently.  Finally,  the  CTRI  filter  was  evaluated 
with  each  measurement  not  available  and  the  variances  for  the  other  mea¬ 
surements  set  at  the  baseline  values.  Again,  both  error  angle  measure¬ 
ments  v/ere  removed  at  the  same  time.  A  suttnary  of  the  variances  used 
to  investigate  the  sensitivity  of  the  CTRI  filter  to  variations  in  the 
measurement  noises  is  presented  in  Table  V-2. 

Figures  of  Merit 

Various  figures  of  merit  were  employed  for  the  comparison  of  the 
three  filter  models  and  the  evaluation  of  the  effect  of  different  update 
rates  on  the  performance  of  the  CTRI  filter.  Nine  figures  of  merit  were 
calculated  for  the  comparison  of  the  <3J!UDG,  GMI,  and  CTRI  filters.  These 
figures  were: 

1)  the  scalar  magnitude  of  the  three  dimensional  vector  of  the 
approximate  time  average  of  the  mean  errors  of  position,  and  similarly 
calculated  scalar  magnitudes  for  velocity  and  acceleration  (all  rounded 
to  the  nearest  whole  number) , 

2)  the  peak  scalar  magnitude  of  the  three  dimensional  vector  of 
the  mean  error  of  position,  and  similarly  calculated  scalar  magnitudes 
for  velocity  and  acceleration  (all  rounded  to  the  nearest  whole  number) , 

and 

3)  the  scalar  magnitude  of  the  approximate  time  average  of  the 
three  dimensional  standard  deviation  vector  of  the  errors  ccrmitted 
by  the  filter  for  position,  and  similarly  calculated  scalar  magnitudes 
for  velocity  and  acceleration  (rounded  to  the  largest  whole  nunber) . 


76 


The  scalar  magnitudes  of  the  average  of  the  mean  errors  were  calculated 
by  first  estimating  the  time  average  of  the  mean  error  for  each  component 
of  the  position,  velocity,  and  acceleration  vectors.  Then,  using  these 
components  of  the  average  mean  errors,  the  rss  magnitudes  for  the  average 
mean  errors  of  position,  velocity,  and  acceleration  were  computed.  The 
peak  scalar  magnitudes  of  the  mean  errors  were  calculated  by  using  the 
mean  error  for  each  component  of  the  desired  vectory  (position,  velocity, 
and  acceleration)  at  time  t  that  produced  the  largest  magnitude  of  the 
mean  error,  finally,  the  scalar  magnitudes  of  the  time  average  of  the 
standard  deviation  were  computed  -by  estimating  the  time  average  of  the 
standard  deviation  of  the  errors  cormitted  by  the  filter  frcm  the  SOFEPL- 
generated  plots  for  each  component  of  position,  velocity,  and  acceleration. 
Hien,  tne  rss  magnitude  of  the  standard  deviation  for  the  position,  velocity, 
and  acceleration  vectors  were  calculated  using  these  estimates.  For 
Trajectory  1,  the  nine  figures  of  merit  were  computed  over  the  total  12 
seconds  of  the  simulation,  while  the  figures  of  merit  for  Trajectory  2 
and  Trajectory  3  were  calculated  over  the  intervals  of  5  to  12  seconds 
and  4  to  12  seconds,  respectively.  These  shorter  intervals  for  Trajectory  2 
and  Trajectory  3  were  used  to  eliminate  the  influence  of  the  initial  5  g 
normal  acceleration  turn  on  the  figures  of  merit  for  these  trajectories 
since  the  inclusion  of  the  initial  5  g  normal  acceleration  turn  would  bias 

the  results.  (Note  that  the  S0F2PL  plots  provide  results  from  0  to  12  seconds.) 

For  the  evaluation  of  the  effect  of  update  rates  on  the  performance 
of  the  CTHI  filter,  the  time  average  of  the  standard  deviation  of  the  errors 
caimitted  by  the  filter  for  each  state  variable  was  plotted  versus  the 
update  interval  for  which  the  average  was  calculated.  Only  simulations 
against  Trajectory  2  were  used  to  evaluate  the  effect  of  update  rates 
since  this  trajectory  was  the  most  difficult  of  the  three  simulated  tra- 
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jectories  for  the  CTRI  filter  to  track  (See  Section  VI) . 

To  evaluate  the  effect  of  different  variances  of  the  measurement 
noises,  the  plots  for  each  of  the  state  variables  from  the  SOFEPL  program 
for  the  CTPI  filter  with  the  different  variance (s)  were  compared  directly 
with  the  corresponding  plot  of  the  same  state  variable  using  the  baseline 
measurement  noise  variances  (as  described  in  Section  III) ;  the  percent 
difference  (rounded  to  the  nearest  percent)  was  then  calculated.  This 
approach  was  used  since  not  all  the  state  variables  were  affected  by 
changes  in  the  measurement  noise  variances.  Also,  only  simulations  using 
Trajectory  2  were  evaluated  for  the  same  reason  discussed  above. 
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VI  Results 


General  Performance  of  the  Three  Filters 

Before  the  direct  comparison  between  filters  is  made,  the  general 
performance  of  each  filter  will  be  discussed  to  provide  physical  insight 
into  the  results.  Figures  C-l  to  C-27  are  the  plots  of  the  results  from 
the  Monte  Carlo  simulations  of  the  GMLOS  filter  for  the  three  trajectories 
used.  The  GMLOS  filter  was  characterized  by  a  nearly  unbiased  estimate 
of  the  position  along  the  estimated  LOS  and  oscillatory  biased  estimates 
of  the  two  cross  range  (2-  and  3-axes  of  the  filter's  coordinate  frame) 
positions,  the  three  velocity  components,  and  the  three  acceleration 
components.  Furthermore,  when  a  high  rate  of  change  of  acceleration 
was  present  as  in  Trajectory  2  and  Trajectory  3,  these  eight  estimates 
exhibited  large  mean  errors.  The  biases  in  the  estimates  and  the  large 
mean  errors  were  a  result  of  the  inadequacy  of  the  assumed  target  relative 
acceleration  model.  This  model,  a  first  order  zero  mean  Gauss-Markov 
process,  did  not  accurately  model  the  target  acceleration  when  the  target 
acceleration  was  not  highly  coorelated  with  attacker  acceleration  (See 
Section  II)  as  was  the  case  in  Trajectory  2  and  Trajectory  3.  Thus,  the 
GMLOS  filter  had  an  inherent  lag  in  the  estimates  of  the  states  when  unmodeled 
maneuvers  with  persistent  turning  accelerations  were  encountered.  Furthermore, 
the  measurement  updates  kept  the  filter  from  diverging  while  the  un- 
modeled  maneuver  was  occurring.  The  oscillations  apparent  in  the  estimates 
had  both  high  frequency  and  lew  frequency  characteristics.  The  high 
frequency  oscillation  readily  seen  in  the  plot  of  the  position  estimate 
along  the  2-axis  of  the  filter's  coordinate  frame  for  all  three  trajectories 
(Fig  C-4,  Fig  C-13,  and  Fig  C-22  was  caused  by  the  impulsive  realignment  of 
the  filter's  coordinate  frame  just  before  an  update.  The  low  frequency 


oscillation  appeared  to  be  strongly  trajectory-dependent.  For  Trajectory  1, 
this  oscillation  presisted  for  the  duration  of  the  simulation;  while  for 
Trajectory  2  and  Trajectory  3,  the  intervals  where  the  target  maneuver 
was  fairly  dynamic  appeared  to  aid  in  reducing  the  ampli tude  of  low 
frequency  oscillation.  One  feasible  explanation  was  that  the  increased 
manuevering  overcame  an  observability  problem  that  occurred  during  Tra¬ 
jectory  1  (constant  target  maneuver) .  Also,  the  zero-mean  Gauss-Markov  model 
was  more  representative  of  target  accelerations  levels  that  were  more 
dynamic  and  less  persistent. 

For  Trajectory  1,  the  mean  errors  of  all  the  estimates  of  the 
states  were  within  the  envelope  of  plus  or  minus  the  square  root  of  the 
corresponding  filter-computed  conditional  variance.  This  was  expected 
since  the  target  and  attacker  accelerations  were  correlated  (the  target's 
acceleration  was  closely  approximated  by  the  attacker's  acceleration) . 
However  for  Trajectory  2  and  Trajectory  3,  the  mean  errors  for  most  of 
the  estimates  of  the  states  exceeded  this  envelope.  Furthermore,  in 
the  case  of  Trajectory  3,  this  envelope  necked  down  during  the  interval 
when  the  target  acceleration  was  rapidly  changing  and  was  uncorrelated 
with  the  attacker's  acceleration.  (That  is,  the  attacker's  acceleration 
provided  no  information  about  the  target's  acceleration.)  The  large  mean 
errors  and  the  failure  of  the  filter's  conditional  variance  to  reflect 
the  growth  of  the  mean  errors  indicated  that  the  filter  was  putting  too 
much  weight  on  the  results  from  the  dynamics  model  and  not  enough  weight 
on  the  information  contained  in  the  measurements.  Therefore,  the  tuning 
issue  for  the  CMLQS  filter  should  be  further  explored  or  the  use  of 
adaptive  Kalman  filter  techniques  should  be  investigated  to  alleviate 
this  problem. 

The  plots  of  the  results  frcm  the  Ntonte  Carlo  simulations  for  the 
GME  filter  for  the  three  trajectories  are  presented  in  Fig  D-l  to  D-27. 

The  characteristics  of  th<°  GMT  filter  were  a  nearly  unbiased  estimate  of 


the  position  along  the  north-axis  of  the  filter's  ooordinate  system  and 
lew  frequency  oscillatory  biased  estimates  of  the  positions  along  the 
east-  and  down-axis,  the  three  components  of  velocity,  and  the  three 
components  of  acceleration.  (Note  that  if  the  trajectories  had  been 
flown  along  the  east-axis,  the  results  would  be  rotated  +90  degrees 
about  the  filter's  down-axis).  Moreover,  when  the  filter  was  required 

to  track  a  target  with  a  high  rate  of  change  of  acceleration  as  for 
Trajectory  2  and  Trajectory  3,  large  mean  errors  resulted  for  these  eight 
estimates.  The  biases  in  these  estimates  observed  for  all  three  tra¬ 
jectories  and  the  large  mean  errors  for  Trajectory  2  and  Trajectory  3 
were  caused  by  the  inability  of  the  assumed  target  acceleration  model  to 
represent  the  actual  target  acceleration  accurately.  The  target  accelera¬ 
tion  model  used  for  the  GMI  filter  assumed  that  the  total  inertial  target 
acceleration  was  adequately  modeled  by  a  first  order  Gauss -Markov  process 
with  a  zero  mean,  while  the  actual  target  acceleration  was  not  zero-mean 
nor  a  first  order  Gauss-Markov  process.  Thus,  when  unmodeled  maneuvers 
were  encountered,  the  GMT  filter  did  not  accurately  predict  the  states 
and  had  an  inherent  lag  in  the  estimates  of  the  states.  Furthermore,  the 
information  provided  by  the  measurement  updates  maintained  the  stability 
of  the  filter  until  the  unmodeled  maneuver  was  completed.  Like  the  GMUDS 
filter,  the  low  frequency  oscillations  appeared  to  be  trajectory-dependent 
(as  discussed  above) . 

The  mean  errors  of  the  estimates  of  the  GMI  filter  for  Trajectory  1 
were  all  within  the  envelope  of  plus  or  minus  the  square  root  of  the  filter's 
corresponding  conditional  variance,  as  expected,  since  the  actual  target 
acceleration  was  not  drastically  different  from  the  assumed  model.  However, 
for  Trajectory  2  and  Trajectory  3,  the  mean  errors  of  the  estimates  ex¬ 
hibited  large  excursions  outside  the  envelope  of  the  filter's  corresponding 
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conditional  standard  deviation.  Furthermore,  the  filter's  variances 
for  Trajectory  2  or  Trajectory  3  did  not  reflect  the  growth  of  the  mean 
errors  during  the  intervals  where  the  assumed  target  acceleration  model 
was  providing  incorrect  predictions  of  the  states.  As  with  the  G-IL06  filter 
the  C?-1  filter  appeared  to  be  weighting  the  results  from  the  dynamics 
model  too  much  and  not  weighting  the  information  provided  by  the  measure¬ 
ment  updates  enough.  Two  alternatives,  retuning  the  filter  or  using 
adaptive  Kalman  filter  techniques  should  be  explored  to  eliminate  these 
problems. 

The  plots  of  the  results  from  the  Monte  Carlo  simulations  of  the 
CTRE  filter  for  the  three  trajectories  are  presented  in  Fig  E-l  to  E-27. 

The  results  were  characterized  by  nearly  unbiased  estimates  of  the  states, 
except  during  initial  transients  for  estimates  of  the  position  and  velocity 
states  along  the  east-axis.  The  small  bias  values  observed  were  expected 
since  the  trajectories  were  well  described  as  constant  turn  rate  tra¬ 
jectories  except  during  the  intervals  of  rapid  acceleration  changes. 

Large  mean  errors  occurred  during  these  intervals  and  were  a  result  of 
the  inadequacy  of  the  assumed  constant  turn  rate  model  to  represent  the 
rapidly  varying  actual  target  acceleration.  The  inadequacy  of  the  model 
caused  incorrect  estimates  of  the  states,  and  the  filter  lagged  the  actual 
target  parameters;  however  the  CTRE  model  was  more  representative  of  actual 
typical  maneuvers  than  either  first  order  Gauss -Markov  target  acceleration 
models  (except  possibly  during  transient  changes) . 

The  mean  errors  of  the  estimates  for  the  CTRE  evaluated  against 
Trajectory  1  were  within  the  envelope  of  plus  or  minus  the  square  root 
of  the  filter’s  corresponding  conditional  variance.  However,  as  with 
the  CMLC6  filter  and  GME  filter,  the  mean  errors  of  most  of  the  estimates 
for  the  CTRE  when  evaluated  against  Trajectory  2  and  Trajectory  3  exceeded 
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this  envelope.  The  filter's  atterrpt  to  increase  the  conditional  variance 
significantly  lagged  the  onset  of  the  maneuver.  The  large  increase  in 
mean  errors  and  the  failure  of  the  filter  to  increase  the  conditional 
variances  indicated  that  too  much  weight  was  given  to  the  predictions  of 
the  dynamics  model  and  too  little  weight  was  given  to  the  information  pro 
vided  by  the  measurements.  Retuning  the  filter  or  use  of  adaptive  Kalman 
filter  techniques  should  be  explored  to  alleviate  these  problems. 

Comparison  of  the  Three  Filters 

The  figures  of  merit  for  each  filter  for  the  three  trajectories 
are  presented  in  Table  VI -1  and  Table  VI -2.  As  seen  from  these  tables, 
the  GMT  filter  provided  estimates  of  the  states  where  both  the  scalar 
magnitudes  of  the  time  average  of  the  three  components  of  mean  error  and 
the  peak  scalar  magnitudes  of  the  three  components  of  mean  error  were 
equal  to  or  less  than  the  corresponding  values  for  the  GMLOS  filter  for 
all  three  trajectories  evaluated.  (A  difference  between  corresponding 
values  of  ten  percent  or  less  was  considered  insignificant  because  of  the 
errors  that  possibly  could  occur  in  determining  both  the  time  average  and 
peak  values  from  the  plots.)  Furthermore,  the  scalar  magnitudes  of  the 
standard  deviations  of  the  errors  ccnmitted  by  the  CMC  filter  were  also 
equal  to  or  smaller  than  the  corresponding  values  for  the  (MLOG  filter. 
(Again,  a  difference  between  corresponding  values  of  ten  percent  or  less 
was  considered  insignificant  because  of  the  errors  that  possibly  could 
occur  in  dtermining  the  values  of  the  standard  deviation  from  the  plots.) 
True  superiority  of  the  GMT  filter  over  the  GMLOS  filter  was  demonstrated 
when  both  filters  were  flown  against  Trajectory  3.  The  scalar  magnitudes 
of  the  average  mean  errors,  the  peak  scalar  magnitudes  of  the  mean  errors 
and  the  scalar  magnitudes  of  the  standard  deviations  of  the  errors  for 


the  GT  filter  were  20  to  57  percent  less  than  the  corresponding  values 
for  the  CMLOS  filter.  This  trend  was  expected.  The  target  acceleration 
model  for  the  GMI  filter  assumed  no  correlation  between  the  accelerations 
of  the  target  and  attacker  while  the  GMLOS  filter's  target  acceleration 
model  assumed  correlated  accelerations  between  the  target  and  attacker 
(as  discussed  in  Section  II) .  Since  the  actual  target  and  attacker  accel¬ 
erations  were  nearly  uncorrelated  during  the  maneuver  for  Trajectory  3, 
the  GMI  filter's  acceleration  model  was  a  better  approximation  of  the 
actual  target  acceleration  than  the  acceleration  model  for  the  OiDOS 
filter. 

When  the  performance  of  the  CTRI  filter  was  compared  to  the  per¬ 
formance  of  the  GMI  filter  using  the  scalar  magnitudes  of  the  average  mean 
errors  and  the  peak  scalar  magnitudes  of  the  mean  errors,  the  CTRI  filter 
performed  as  well  as  or  better  than  the  GMI  filter  except  for  the  peak 
scalar  magnitude  of  the  mean  error  for  position.  (A  difference  of  cor¬ 
responding  values  of  ten  percent  or  less  was  considered  insignificant  as 
discussed  above.)  However,  when  the  scalar  magnitudes  of  the  standard 
deviations  of  the  errors  were  compared,  the  superiority  of  the  CTRI  filter 
was  not  apparent.  For  example,  for  Trajectory  1,  the  GMI  filter  had  lower 
scalar  magnitudes  of  the  standard  deviations  than  did  the  CTRI  filter. 
However,  this  comparison  was  dependent  on  hew  well  the  GMI  filter  was 
tuned  compared  to  how  well  the  CTRI  filter  was  tuned,  and  the  issue  was 
not  explored  further  because  of  the  complexity  of  the  CTRI  acceleration 
model  and  time  constraints.  The  true  superiority  of  the  CTRI  filter 
over  the  GMI  filter  was  demonstrated  by  the  decrease  in  the  scalar  mag¬ 
nitude  of  the  average  mean  errors  and  peak  scalar  magnitudes  of  the  mean 
errors  for  the  acceleration  states  by  47  and  41  percent,  respectively, 
and  the  decrease  in  the  magnitudes  of  the  average  mean  error  for  the 
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velocity  states  by  53  percent.  The  trend  exhibited  by  these  decreases 
was  anticipated  since  the  CTRI  filter's  acceleration  model  more  nearly 
represented  the  actual  target  acceleration  for  Trajectory  2  than  did  the 
GMi  filter's  acceleration  model.  Furthermore,  the  rms  error  {defined  as 
the  square  root  of  the  square  of  the  mean  error  plus  the  variance  of  the 
error)  should  be  evaluated. 

Finally,  when  comparing  the  filter's  performances,  the  opportunity 
for  an  actual  gunnery  solution  had  to  be  considered  before  finally  select¬ 
ing  between  the  (ML  and  CTRI  target  acceleration  model.  For  example, 
during  the  high  roll  rate  maneuver  of  Trajectory  2,  the  attacker,  using 
gunnery  lead  collision  tracking,  could  not  obtain  a  gunnery  solution  until 
the  completion  of  the  maneuver  assuming  the  roll  rates  of  the  two  aircraft 
were  equal.  The  direction  of  the  velocity  vector  of  the  attacker  would 
lag  the  direction  of  the  velocity  vector  of  the  target  by  some  fixed 
angle  (a  function  of  the  pilot's  reaction  time)  until  the  target  aircraft 
completed  the  roll.  Therefore,  the  attacker  would  not  be  able  to  obtain 
the  relative  position  needed  to  provide  the  gunnery  solution,  and  the 
errors  in  the  estimates  provided  by  the  filter  would  not  be  critical  as 
long  as  the  filter  recovered  from  these  errors  rapidly.  However,  for 
Trajectory  3,  the  situation  was  entirely  different  since  the  ginnery 
solution  must  be  achieved  during  the  period  when  the  angular  rate  of  the 
target  with  respect  to  the  attacker  is  large.  This  was  l^ie  only  time 
when  the  attacker  had  an  opportunity  to  obtain  a  gunnery  solution  during 
the  attack,  assuming  both  aircraft  could  obtain  the  same  normal  accelera¬ 
tion  value.  As  the  target  continued  the  turn  into  the  attacker,  the 
attacker  could  eventually  not  be  able  to  pull  enough  lead  on  the  target. 
At  that  moment,  the  attacker's  firing  opportunity  would  be  lost.  Thus 
the  filter's  estimates  during  the  interval  were  extremely  important,  and 
any  errors  in  these  estimates  would  be  critical  to  the  accuracy  of  the 

gunsight.  Another  consideration  in  actual  implementation  would  be  the 
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corputer  resources  required.  The  CTRI  filter  required  176  multiplica¬ 
tions,  223  additions,  and  20  divisions  for  each  propagation  step  while 
the  GMT  filter  required  18  multiplications,  162  additions,  and  no  divisions. 
The  computer  resources  required  for  an  update  were  the  same  since  both 
filters  used  the  same  measurement  equations.  Thus,  the  requirement  for 
increased  accuracy  as -provided  by  the  CTRI  filter  would  have  to  be  weighed 
against  the  subtan tially  increased  computer  requirements.  Finally,  the 
relative  robustness  of  both  the  <241  and  CTRI  filters  to  variations  in 
parameters,  measurement  noise,  tuning,  and  imperfect  initial  conditions 
should  be  investigated  to  provide,  additional  insight  into  which  filter 
is  the  better  choice  for  implementation , 

Effect  of  Update  Rate  on  CTRI  Filter  Performance 

The  plots  of  the  three  components  of  the  time  average  of  the  stand¬ 
ard  deviations  of  the  errors  committed  by  the  CTRI  filter  are  presented 
in  Fig  VI -1,  Fig  VI -2,  and  Fig  VI-3  for  the  position,  velocity,  and  accel¬ 
eration,  respectively.  The  points  for  these  plots  were  obtained  from 
Fig  F-l  to  Fig  F-27  and  from  Fig  E-10  to  Fig  E-18.  The  results  presented 
in  Fig  VI-1,  Fig  VI -2,  and  Fig  VI-3  indicate  that  when  the  sample  period 
was  increased  from  0.04  seconds  to  0.24  seconds,  the  performance  of  the 
CTRI  filter  against  Trajectory  2  was  not  significantly  degraded.  However, 
the  actual  plots  of  the  results  from  the  Monte  Carlo  simulation  Fig  F-l 
to  Fig  F-27  and  Fig  E-10  to  Fig  E-18  indicate  that  as  the  sample  period 
was  increased,  the  mean  error  plots  exhibited  larger  excursions  from  the 
mean  error  of  the  corresponding  state  for  a  sample  period  of  0.04  seconds. 
Further,  the  condition  variance  of  the  filter  for  each  state  grew  as  the 
vpdate  interval  was  increased.  These  trends  were  expected;  however,  the 
deviation  of  the  mean  error  with  an  increase  in  sample  period  was  more 
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Figure  VI-1.  Performance  of  the  Position  Estimates  for  the  CTRI  Filter 
'.'Then  Flcwn  Against  Trajectory  2  for  Various  Sanple  Periods 
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Figure  '71-2.  Performance  of  the  Velocity  Estimates  for  the  CTRI  Filter 
When  Flown  Against  Trajectory  2  for  Various  Sample  Periods 


irregular  then  expected  especially  for  sample  periods  of  0.16  seconds 
and  0.24  seconds.  (The  rms  error  should  be  evaluated  for  confirm  the 
results.)  Apparently,  the  use  of  a  constant  descriptor  Q  of  the 
dynamic  driving  noise  to  evaluate  the  performance  of  the  CTRI  filter 
for  the  longer  sample  period  was  inappropriate  even  though  the  dynamics 
were  considered  to  be  continuous  functions  of  time.  The  filter  was 
dependent  on  a  necessarily  erroneous  dynamics  model  for  the  longer  inter¬ 
vals  so  additional  pseudonoise  would  be  required  as  the  sample  period  was 
increased.  Additional  evaluations  of  the  filter's  performance  with  in¬ 
creased  pseudonoise  should  be  accomplished  if  longer  sample  periods  are 
required.  However,  sample  periods  of  less  than  0.08  seconds  could  be 
used  with  confidence. 

Effects  of  Variations  in  Measurement  Noise  for  the  CTRI  Filter 

The  results  for  the  variations  in  the  elements  of  the  descriptor  R 
of  the  measurement  noises  for  the  CTRI  filter  only  (as  discussed  in 
Section  V)  are  presented  in  Table  VI-3,  Talbe  VI-4,  and  Table  VI-5.  The 
plots  of  the  results  of  the  Monte  Carlo  simulations  which  were  used  to 
calculate  the  approximate  percent  change  between  the  time  average  of  the 
values  for  the  baseline  case  and  the  case  being  evaluated  over  the  inter¬ 
val  from  5  to  12  seconds  are  presented  in  Fig  E-10  to  Fig  E-18  (baseline 
case) ,  Fig  G-l  to  Fig  G-27  (variations  of  the  variance  of  the  range  mea¬ 
surement  noise) ,  Fig  H-l  to  Fig  H-2  (variations  of  the  variances  of  the 
error  angle  measurement  noises)  ,  and  Fig  1-1  to  Fig  1-27  (variations  of  the 
variance  of  the  range  rate  measurement  noise) .  As  the  variance  of  the  range 
noise  was  increased,  the  performance  of  the  CTRI  filter  against  Tra¬ 
jectory  2  varied  significantly  only  in  the  position  estimate  along  the 
north-axis.  The  time  average  of  the  standard  deviation  of  the  errors  and 
the  time  average  of  the  square  root  of  the  filter's  conditional  variance 
increased  200  percent  as  the  variance  of  the  range  measurement  noise 
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TABLE  VI -3.  Effect  of  Variations  of  the  Variance  of  the 

Bange  Measurement  o^on  the  Performance  of  the 
CTRI  Filter  When  Flown  Against  Trajectory  2 


Divergent  Divergent  Divergent  Divergent  Divergent  Divergent  Divergent  Divergent  Divergent 


Measurement 


increased  by  two  orders  of  magnitude.  Since  the  range  measurement  was  along 
the  north-axis  for  mast  of  Trajectory  2,  the  effect  of  a  variation  in  the 
variance  of  the  range  measurement  noise  was  expected  along  that  axis.  Fur¬ 
thermore,  since  the  velocity  estimates  were  one  integration  removed  from 
the  range  measurement  and  the  acceleration  estimates  were  two  integra¬ 
tions  removed,  the  effects  of  the  variation  of  the  variance  of  the  range 
measurement  noise  had  little  effect  on  these  estimates.  Moreover,  when 
no  range  measurements  were  available,  the  CTRI  filter  still  was  able  to 
estimate  the  states,  when  provided  the  exact  initial  conditions,  without 
diverging.  (Note  that  the  range  rate  measurement  was  still  available 
and  would  provide  range  information.) 

For  variations  of  the  variances  of  the  error  angle  measurement 
noises  o  a  and  a  e,  the  major  effect  was  apparent  in  the  position  and 
velocity  estimates  along  the  east-  and  down-axis.  As  these  variances 
were  increased  by  two  orders  of  magnitude,  the  time  average  of  the  mean 
error,  the  standard  deviation  of  the  error,  and  the  square  root  of  the 
filter's  conditional  variance  of  these  estimates  increased  approximately 
110  percent.  The  information  available  frcm  the  error  angle  measurements 
for  Trajectory  2  was  mostly  along  the  east-  and  down-axis.  Thus,  the 
effects  of  the  variation  of  the  variances  of  the  error  angle  measurement 
noises  visible  in  these  estimates  were  as  expected.  Furthermore,  when 
the  error  angle  measurements  were  not  available,  the  filter  was  not  able 
to  estimate  the  states  even  though  the  filter  started  frcm  perfect  initial 
conditions.  The  lack  of  these  measurements  apparently  created  an  observa¬ 
bility  problem. 

2 

When  the  variance  of  the  range  rate  measurement  noise  a  ^  was  varied, 
the  position,  velocity  and  acceleration  estimates  along  the  north-axis 
showed  the  major  effects.  As  the  variance  was  increased  by  two  orders 


of  magnitude  the  time  average  of  the  standard  deviation  of  the  error  and 
the  square  root  of  the  filter's  conditional  variance  increased  approximately 
40  percent  while  the  mean  error  did  not  vary  significantly.  As  with  the 
range  measurement,  the  range  rate  measurement  for  Trajectory  2  provided 
information  along  the  north-axis,  and  the  variation  of  the  three  estimates 
along  the  north-axis  with  changes  in  the  variance  of  the  range-rate  mea¬ 
surement  noise  was  as  expected.  Furthermore,  the  CTRI  filter  was  able  to 
estimate  the  states  without  a  range  rate  measurement  from  perfect  initial 
conditions  without  diverging.  (Note  that  the  range  measurement  was  still 
available  and  would  provide  range,  rate  information.) 

Based  on  these  results,  the  CTRI  filter  demonstrated  the  ability 
to  perforin  adequately  even  for  large  changes  in  the  variances  of  the  range 
and  range  rate  measurement  noises  used  for  the  filter.  However,  the  filter 
was  sensitive  to  variations  in  the  variances  of  the  error  angle  measurement 
noises.  Furthermore,  the  filter  was  evaluated  with  perfect  initial  condi¬ 
tions  provided  to  the  filter,  and  additional  evaluations  of  the  filter 
for  uncertain  initial  conditions  should  be  performed  to  establish  the 
sensitivity  of  the  filter  to  the  changes  of  the  variances  of  the  measure¬ 
ment  noises. 


98 


VII  Conclusions  and  Reccmmendations 


Conclusions 

The  CTRI  filter  and  the  GMT  filter  provide  performance  equal  to 
or  superior  to  the  performance  of  the  CMLQS  filter  for  the  three  tra¬ 
jectories  evaluated  for  this  thesis,  then  the  target  acceleration  pro¬ 
files  are  not  demanding  (as  in  Trajectory  1) ,  the  performance  is  nearly 
the  same  for  the  three  filters.  However,  as  the  target  acceleration 
profiles  become  more  demanding  (Trajectory  2  and  Trajectory  3)  the  per¬ 
formance  of  the  CJ-TLOS  filter  is  worse  than  the  performance  of  either  of 
the  other  two  filters.  The  figures  of  merit  for  the  OH  filter  are  at 
least  20  percent  less  than  the  corresponding  figures  for  the  GMLOS  filter 
for  Trajectory  3,  while  the  figures  of  merit  (except  for  the  scalar 
magnitude  of  the  time  average  of  the  standard  deviation  of  the  error) 
for  the  CTRI  filter  are  in  general  at  least  20  percent  less  than  the  cor¬ 
responding  figure  for  the  CMjCS  filter.  Furthermore,  for  Trajectory  2, 
the  CTRI  filter  provides  the  best  estimates  of  the  states,  as  expected, 
since  the  actual  target  acceleration  is  better  modeled  by  a  CTRI  accel¬ 
eration  model  than  by  either  the  GMLOS  or  Gt-H  acceleration  models.  More¬ 
over,  for  the  more  demanding  target  acceleration  trajectories,  there  is 
a  tuning  issue  that  requires  further  study  to  explore  the  reduction  of 
the  large  excursions  of  the  mean  error  experienced  during  the  periods  of 
poorly  modeled  actual  target  accelerations.  Finally,  the  CTRI  filter 
requires  substantially  more  arithemetic  operations  (176  multiplications 
for  the  CTRI  filter  versus  18  for  the  GMT  filter,  223  additions  for  the 
CTRI  filter  versus  162  for  the  OH  filter,  and  20  divisions  for  the  CTRI 
filter  versus  none  for  the  OH  filter)  than  the  CMI  filter  for  each  pro¬ 
pagation  step. 


Sample  periods  for  the  CTRI  filter  of  0.04  seconds  and  0.08  seconds 
provide  estimates  of  the  states  that  are  not  significantly  different. 

However,  as  the  sample  period  is  increased  to  0.16  seconds  and  0.24  seconds, 
the  estimates  of  the  states  become  very  irregular,  and  the  use  of  the  same 
descriptor  Q  of  the  dynamic-  driving  noise  apparently  is  inappropriate. 

The  CTRI  filter  depends  on  an  erroneous  dynamics  model  fcr  longer  intervals 
requiring  the  addition  of  pseudonoise  as  the  sample  period  is  increased. 

In  any  case,  sairple  periods  of  less  than  0.08  seoonds  provide  adequate 
filter  performance,  and  should  be  used  for  implementation. 

The  effects  of  the  variations  of  the  variances  of  the  measurement 
noises  are  as  expected  for  the  CTRI  filter.  When  the  variance  of  the  range 
measurement  noise  is  increased  by  ten  orders  of  magnitude,  only  the  time 
average  of  the  standard  deviation  of  the  error  and  the  time  average  of  the 
square  root  of  the  filter's  conditional  variance  of  the  position  estimate 
along  the  estimated  IOS  are  increasing  approximately  200  percent.  When  there 
is  no  range  measurement,  but  perfect  initial  conditions  are  available,  the 
CTRI  filter  is  able  to  estimate  the  states  without  diverging.  For  an  in¬ 
crease  of  two  orders  of  magnitude  of  the  variances  of  the  error  angle  mea¬ 
surement  noises,  only  the  time  average  of  the  mean  error,  the  time  average 
of  the  standard  deviation  of  the  error,  and  the  time  average  of  the  square 
root  of  the  filter's  conditional  variance  for  the  position  and  velocity 
along  the  east-  and  dcwn-axis  (over  the  same  interval)  increase  with  the 
increase  approximately  110  percent.  Furthermore,  when  the  error  angle 
measurements  are  not  available,  the  filter  can  not  estimate  the  states  even 
though  perfect  initial  conditions  were  provided  since  the  filter  diverges, 
indicating  that  there  is  an  observability  problem.  Increasing  the  variance 
of  the  range  rate  measurement  noise  by  two  orders  of  magnitude  increases 
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only  the  time  average  of  the  standard  deviations  of  the  error  and  the 
time  average  of  the  square  root  of  the  filter's  conditional  variance 
for  the  same  interval  along  the  estimated  LC6  for  position,  velocity, 
and  acceleration  with  the  increase  approximately  40  percent.  If  the 
range  rate  measurement  is  not  available,  the  CTRI  filter  still  is  able 
to  estimate  the  states  from  perfect  initial  conditions  without  diverging. 
The  CTRL  filter  is  most  sensitive  to  variations  in  the  accuracy  of  the 
measurements  of  the  error  angles  while  the  accuracy  of  the  range  and 
range  rate  measurements  are  not  as  critical. 

Recotmendations 

The  (341  and  CTRI  filters  should  be  developed  with  noise  added  to 
the  measurements  provided  by  the  IMU  and  with  a  dynamics  model  for  the 
tracker.  The  use  of  an  inperfect  IMU  would  affect  the  propagation  (by 
noisy  attacker  velocity  measurements)  and  the  update  (by  the  noisy  trans¬ 
formations  from  the  earth-fixed  reference  frame  to  the  attacker's  body 
axis)  for  both  filters.  Also,  the  (31L0G  filter  should  be  modified  to 
include  the  tracker  dynamics .  These  new  models  would  allow  evaluation  of 
filters  that  more  nearly  represent  the  actual  system  that  would  be  imple¬ 
mented.  Then  these  filters  should  be  evaluated  versus  several  different 
trajectories  to  insure  that  the  trends  identified  in  this  thesis  are  also 
true  for  the  more  realistic  models. 

Additional  evaluations  of  the  effects  of  different  update  rates 
should  be  accomplished  with  the  CTRI  filter  retuned  for  each  different 
update  rate  with  pseudonoise  added  to  compensate  for  the  dependence  of 
the  filter  on  an  erroneous  dynamics  for  longer  periods  as  the  sarrple 
period  is  increased.  Further,  the  mi  filter  should  also  be  included 
in  this  evaluation  since  it  is  certainly  a  good  candidate  for  implementa¬ 
tion. 
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'The  robustness  of  the  GMIOS.  GMI ,  and  CTRI  filters  using  the  new 
models  discussed  above  should  be  evaluated  to  determine  the  effect  of 
variations  in  dynamics  and  measurement  model  parameters,  dynamic  driving 
noise  statistics,  and  measurement  noise  statistics. 

All  three  filters  should  be  investigated  to  explore  the  effect  of 
a  retuning  effort  on  the  mean  errors,  standard  deviations  of  the  errors, 
and  the  peak  mean  errors.  The  filters  should  be  tuned  to  match  the  filter's 
confuted  conditional  variances  with  the  root  mean  square  of  the  true  errors 
cornu,  tted  by  the  filter  to  guard  against  severe  biases. 

The  recovery  from  bad  initial  conditions  of  the  three  filters  should 
be  investigated  since  this  issue  was  not  addressed  in  the  results  presented 
in  this  thesis.  If  additional  robustness  is  required,  a  constant  gain  ex¬ 
tended  Kalman  filter  implementation  should  be  explored. 

Finally,  if  the  retuning  of  the  filters  does  not  provide  substantially 
better  performance ,  the  addition  of  a  bias  correction  term  or  the  use  of 
adaptive  Kalman  filter  techniques  should  be  explored  to  provide  the  desired 
reductions  of  the  mean  errors,  standard  deviation  of  the  error,  and  peak 


mean  errors. 


Bibliography 


1.  Fosha,  Charles  E. ,  Anthony  L.  Leatham,  and  Roger  P.  Nee land, 

"A  Digital  Line  of  Sight  Estimator  Employing  the  Ascot  Electro- 
Optical  Sensor  For  Air-to-Air  Gunnery  Engagements",  Technical 
Report  USAFA-TR- 77-11,  prepared  for  the  Avionics  laboratory, 

Wright  Patterson  AFB,  CH,  Jun  1977. 

2.  Reid,  J.  Gary,  "Modem  Principles  of  Avionics  Fire  Control  and 
Armament" ,  lecture  Notes,  Air  Force  Institute  of  Technology, 

1980. 

3.  Maybeck,  Peter  S.,  "Stochastic  Estimation  and  Control",  Lecture 
Notes,  1980. 

4.  Silver thorn,  James  T. ,  Discussions  concerning  performance  of 
current  trackers.  Mar  1980. 

5.  Musick,  Stanton  H.,  "SQFE :  A  Generalized  Digital  Simulation  for 
Optimal  Filter  Evaluation  User's  ’lanual" ,  Technical  Memorandum 
AFAL-TM-78-19 ,  Revision  A,  Nov  1978. 

6.  Farrell,  James  L. ,  Elmen  C.  Quesinberry,  Charles  D.  Morgan,  and 
Michael  Tom,  Dynamic  Scaling  for  Air-to-Air  Tracking" ,  IEEE 
Proceedings  of  the  National  Aerospace  Electronics  Conference, 

NAECCN  1975,  Dayton,  CH,  May  1975. 

7.  Individual  flight  test  reports  (unpublished)  of  tests  conducted 
at  the  USAF  Test  Pilot  School,  Sep  1975  to  Jun  1976. 

8.  Musick,  Stanton  H.,  Briefings  on  the  use  of  the  SOFEPL  program, 

Apr  1980. 

9.  Bryant,  Ralph  S.,  "Cooperative  Estimation  of  Targets  By  Multiple 
Aircraft",  M.S.  Thesis,  Air  Force  Institute  of  Technology,  Jun  1980. 


103 


APPENDIX  A 


Coordinate  Transformation 

General 

TVo  coordinate  transformations  were  calculated  by  the  filter  used 
for  this  thesis.  One  was  the  transformation  of  a  vector  coordinatized 
in  the  earth-fixed  reference  frame  coordinates  to  the  estimated  LOS  co¬ 
ordinated  frame  (and  its  inverse)  and  the  other  was  the  transformation 
of  a  vector  coordinatized  in  the  attacker's  body  frame  reference  system 
to  the  estimated  LOS  coordinate  frame  coordinates  (and  its  inverse)  . 
(These  axes  systems  are  defined  in  Section  II  and  Section  III.)  Both 
transformations  involved  only  rotations  about  two  axes;  the  correspond¬ 
ing  axis  for  each  transformation  had  no  rotation.  Furthermore,  the 
Euler  angles  n  and  v  with  rotations  in  that  order  were  similarly  defined 
for  each  transformation,  and  both  transformations  used  the  right  hand 
rule  to  determine  positive  rotations.  Therefore,  only  one  transformation 
form  was  required. 


Transformation  Development 

Hie  transformation  from  coordinate  frame  A  to  coordinate  frame  B 
with  the  constraint  that  the  yg-axis  a  rained  in  the  plane  of  the  xA-yA 
axis  required  only  two  Euler  rotation  angles  n  and  v  to  completely  deter¬ 
mine  the  transformation.  By  convention,  the  first  rotation  occur ed  about 
the  zA-axis  as  shown  in  Fig  A-l  to  an  intermediate  coordinate  frame  C. 

The  transformation  of  the  unit  vectors  xA,  yA,  and  zA  of  coordinate 
frame  A  to  the  unit  vectors  x^,  y^,  and  Zq  of  coordinate  frame  C  is  given 

by 
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.gure  A-l.  Rotation  About 


The  second  rotation  about  the  y^-axis  (shown  in  Fig  A-2)  in  which  the 
unit  vectors  xq,  yc,  and  z c  of  the  C  coordinate  frame  were  transformed 
to  the  unit  vectors  Xg,  yQ,  and  z^  of  the  B  coordinate  frame  is  given  by 
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Cbtnbining  the  transformations  in  the  proper  order,  the  transformation  Tg 
frcm  the  A  coordinate  frame  to  the  B  coordinate  frame  is  given  by 
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where  c  and  s  denote  cosine  and  sine,  respectively. 


APPENDIX  B 

Graphical  Results  of  the  Effect  of  Increasing  Number 
of  Monte  Carlo  Simulations  on  Solution  Accuracy 
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Performance  of  the  Cbnstant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  for  5  '"onte  Carlo  Simulations 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  for  5  Monte  Carlo  Simulations 


TIME  (SECONDS) 

Figure  B-3.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  North-Axis  for  Trajectory  2  for  5  »t>nte  Carlo  Simulations 
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Figure  B-4 .  Performance  of  the  Constant  Turn  Rate  Inertial  Cbordinate  Filter 
Along  the  East-Axis  for  Trajectory  2  for  5  Monte  Carlo  Simulations 
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Figure  B-6.  Performance  of  the  Constant  Turn  Fate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  for  5  Monte  Carlo  Simulations 
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Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter 
Along  the  Down-Axis  for  Trajectory  2  for  5  Monte  Carlo  Simulations 
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Figure  B-8 .  Performance  of  the  Cbnstant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  Down-Axis  for  Trajectory  2  for  5  ‘tonte  Carlo  Simulations 
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Figure  B-10.  Performance  of  the  (Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  North-Axis  for  Trajectory  2  for  10  Monte  Carlo  Simulations 


0*08  o*o9  o*ot  o’az  o‘o  o*az- 

(GN0033/133J)  UIOOT3A 


119 


iZ**  GNQ03S/I33J)  N0IiUy31333d 


120 


TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Pate  Inertial  Cbordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  for  10  Monte  Carlo  Simulations 
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TIME  (SECONDS) 

:ormance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
ig  the  East-Axis  for  Trajectory  2  for  10  Monte  Carlo  Simulations 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  Down-Axis  for  Trajectory  2  for  10  Monte  Carlo  Simulations 
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TIME  (SECONDS) 

Performance  of  the  Oonstant  Turn  Pate  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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B-20.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter, 

Along  the  North-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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Performance  of  the  Oonstant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  Morth-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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Figure  B-22.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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Figure  B-27.  Perfonrance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  for  15  Monte  Carlo  Simulations 
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Figure  C-4.  Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  1 
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Figure  05.  Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  1 
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TIME  (SECONDS) 

Performance  of  the  Gauss-ftarkov  Line  of  Sight  Filter 
Along  the  3-Axis  for  Trajectory  1 
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TIME  (SECONDS) 

Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  3-Axis  for  Trajectory  1 
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TIME  (SECONDS) 

Figure  C-12.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  1-Axis  for  Trajectory  2 
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Figure  C-13.  Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  2 
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Figure  C-14.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  2 
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Figure  C-16.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  3-Axis  for  Trajectory  2 
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Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  1-Axis  for  Trajectory  3 
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Figure  C-23.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  3 
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Figure  024.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  2-Axis  for  Trajectory  3 
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Figure  C-25.  Performance  of  the  Gauss -Markov  Line  of  Sight  Filter 
Along  the  3-Axis  for  Trajectory  3 
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Figure  C-27.  Performance  of  the  Gauss-Markov  Line  of  Sight  Filter 
Along  the  3-Axis  for  Trajectory  3 
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Figure  D-5.  Performance  of  the  Gauss -Markov  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  1 
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Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  Down-Axis  for  Trajectory  1 
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Figure  D-ll.  Performance  of  the  Gauss -Markov  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2 
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Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2 
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Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  2 
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Figure  D-18.  Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  Dcwn-Axis  for  Trajectory  2 
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Performance  of  the  Gauss-Markcrv  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  3 
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Figure  D-20. 


1.0  3.0  4.0  5.C  6.0  7.0  8.0  9.0  10.0  11.0  12.0 

TIME  (SECONDS) 

Figure  D-22.  Performance  of  the  Gauss -Markov  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  3 
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Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  3 
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Figure  D-25.  Performance  of  the  Gauss -Markov  Inertial  Coordinate  Filter 
Along  the  Dcwn-Axis  for  Trajectory  3 
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Performance  of  the  Gauss-Markov  Inertial  Coordinate  Filter 
Along  the  Dcwn-Axis  for  Trajectory  3 
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Graphical  Results  for  the  Constant  Turn  Rate 
Inertial  Coordinate  Filter 
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Figure  E-4.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  East-Axis  for  Trajectory  1 
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Figure  E-5.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  East-Axis  for  Trajectory  1 


[ Z **  QN003S/J33J)  N0Iiyy31303y 


198 


0  3.0  4.0  5.0  6.0  7.0  8.0  fl.O  10.0  11. 0  12.0 

TIME  (SECONDS) 

Figure  F-7.  Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate 
Filter  Along  the  Down-Axis  for  Trajectory  1 
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Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate 
Filter  Along  the  Dcuvn-Axis  for  Trajectory  1 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  North-Axis  for  Trajectory  2 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  East-Axis  for  Trajectory  2 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  Dovn-Axis  for  Trajectory  2 
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TIME  (SECONDS) 

Performance  of  tire  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  North-Axis  for  Trajectory  3 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  North-Axis  for  Trajectory  3 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  North-Axis  for  Trajectory  3 


TIME  (SECONDS) 

Figure  E-22.  Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate 
Filter  Along  the  East-Axis  for  Trajectory  3 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  East-Axis  for  Trajectory  3 


TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  Fast-Axis  for  Trajectory  3 


Figure  E-25.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  Down-Axis  for  Trajectory  3 
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Figure  E-26.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  Down-Axis  for  Trajectory  3 
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TIME  (SECONDS) 

Figure  E-27.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate 
Filter  Along  the  Down-Axis  for  Trajectory  3 


APPENDIX  F 

Graphical  Results  of  the  Effect  of  Variations  in 
Update  Rates  on  the  Performance  of  the  Constant 
Turn  Rate  Inertial  Coordinate  Filter 
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Figure  F-l.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  North-Axis  for  Trajectory  2  with  a  0.08  Second  Sanple  Period 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  with  a  0.08  Second  Sanple  Period 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  North-Axis  for  Trajectory  2  with  a  0.08  Second  Sample  Period 
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Figure  F-4.  Performance  of  the  Constant  Tum  Rate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  with  a  0.08  Second  Sairple  Period 


TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  2  with  a  0.08  Seoond  Sanple  Period 
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F-7.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  with  a  0.08  Second  Sample  Period 
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Figure  F-8.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  with  a  0.08  Second  Sanple  Period 
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TIME  (SECONDS) 

Figure  F-9.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  with  a  0.08  Second  Sairple  Period 
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TIME  (SECONDS) 

:e  F-12.  Performance  of  the  Gonstant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  North-Axis  for  Trajectory  2  with  a  0.16  Second  Sample  Period 


F-13.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  with  a  0.16  Second  Sanple  Period 
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Figure  F-14.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  with  a  0.16  Second  Sanple  Period 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  East-Axis  for  Trajectory  2  with  a  0.16  Second  Sample  Period 
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Figure  F-17.  Performance  of  the  Constant  Turn  Hate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  with  a  0.16  Second  Sample  Period 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
Along  the  Dcwn-Axis  for  Trajectory  2  with  a  0.16  Second  Sample  Period 
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Figure  F-19.  Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter 

^  Along  the  North-Axis  for  Trajectory  2  with  a  0.24  Second  Sample  Period 
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F-20.  Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter 

Along  the  North-Axis  for  Trajectory  2  with  a  0.24  Second  Sanple  Period 
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Figure  f-23.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  East-Axis  for  Trajectory  2  with  a  0.24  Second  Sairple  Period 
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Figure  F-27.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 

Along  the  Down-Axis  for  Trajectory  2  with  a  0.24  Second  Sample  Period 


APPENDIX  G 

Graphical  Results  of  the  Effect  of  Variations  in 
the  Range  Measurement  Noise  on  the  Performance  of 
the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  J 
North -Ax is  for  Trajectory  2  with  a  Range  fteasurement  Noise  Variam 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
East-Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  1000  Feet' 
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Figure  06.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  7 
East-Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  1000  Feet^ 


TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Down-Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  1000  Feet 2 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
North-Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  100000  Feet 
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TIME  (SECONDS) 

G-14.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 

East- Axis  for  Traiectory  2  with  a  Range  Measurement  Noise  Variance  of  100000  Feet1 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Dcwn-Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  100000  Feet 
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Figure  G-17.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 

Hewn -Axis  for  Trajectory  2  with  a  Range  ffeasureroent  Noise  Variance  of  100000  Feet^ 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Down -Axis  for  Trajectory  2  with  a  Range  Measurement  Noise  Variance  of  100000  Feet* 


TIME  (SECONDS) 

Performance  of  the  Constant  Torn  Rate  Inertial  Coordinate  Filter  Along  the 
North-Axis  for  Trajectory  2  with  No  Range  Measurement 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
North-Axis  for  Trajectory  2  with  No  Range  Measurement 
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TIME  (SECONDS) 

G-22.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
East-Axis  for  Trajectory  2  with  No  Range  Measurement 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
East-Axis  for  Trajectory  2  with  No  Range  Measurement 
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G-25.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Dcwn-Axis  for  Trajectory  2  with  No  Range  Measurement 
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Figure  G-26.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Dcwn-Axis  for  Trajectory  2  with  No  Range  Measurement 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
Dcwn-Axis  for  Trajectory  2  with  No  Range  Measurement 


APPENDIX  H 

Graphical  Results  of  the  Effect  of  Variations  of 
the  Error  Angle  Measurement  Noises  of  the  Performance 
of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
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ice  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the 
s  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians 2 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians 2 
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Figure  H-5.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 

Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Bast- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians' 
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Figure  H-7 .  Performance  of  the  Cars  tan  t  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Down- 

Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians' 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Down- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.00001  Radians' 
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Figure  H-ll.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 

Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.001  Radians^ 
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Figure  H-12.  Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter  Along  the  North 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.001  Radi 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.001  Radians2 
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Figure  H-16.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Dcwn- 

Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.001  Radians^ 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Down- 
Axis  for  Trajectory  2  with  Error  Angle  Measurement  Noise  Variances  of  0.001  Radians2 
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Figure  H-20.  Perforrrance  of  the  Constant  Turn  Fate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  No  Error  Angle  Measurements 
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Figure  H-21.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  No  Error  Angle  Measurements 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  No  Error  Angle  Measurements 
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TIME  (SECONDS) 

H-27.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Dcwn- 
Axis  for  Trajectory  2  with  No  Error  Angle  Measurements 


APPENDIX  I 

Graphical  Results  of  the  Effect  of  Variations  of 
The  Range  Rate  Measurement  Noise  on  the  Performance 
of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter 
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’erformanae  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
«is  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  62.5  Feet2/Seoond2 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  a  Range  Rate  Measurment  Noise  Variance  of  62.5  Feet2/Second2 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  62.5  Feet  ^/Second 
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Figure  1-8.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Down- 

Axis  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  62.5  Feet VSeoond' 
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Figure  1-10.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 

Axis  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  6250  Feet2/Second 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Nort^- 
Axis  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  6250  Feet  /S( 
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TIME  (SECONDS) 

Performance  of  the  Constant  Turn  Pate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  a  Range  Rate  Measurement  Noise  Variance  of  6250  Feet  ^/Second 


323 


TIME  (SECONDS) 

Figure  1-19.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurenents 
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Figure  1-20.  Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurements 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  North- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurements 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurements 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  East- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurements 
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Performance  of  the  Constant  Turn  Rate  Inertial  Coordinate  Filter  Along  the  Dcwn- 
Axis  for  Trajectory  2  with  No  Range  Rate  Measurements 
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